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Th«  purpoaa  of  this  thosia  waa  to  davalcqp  a  a«t  of  control 
lawSf  loplamontad  in  a  almulatlon,  to  allow  the  Cruiaa  Miaslla  Control 
Aircraft  (ChMCA)  to  radar  track  cruiaa  miaailoa  and  achiava  100%  radar 
covaraga  during  teat  flighta.  Tha  CMMCA  waa  forcad  to  parfom  a  aariaa 
of  intarcapta  on  aat  pointa  raccoiputad  avary  tan  aaconda.  Fuaay  logic 
fonaad  a  vital  function  in  datarmining  wbara  tha  aat  point  would  ba,  and 
uaad  currant  and  futura  miaaila  poait.ion  data. 

Thia  theaia  davalopmant  and  complation  waa  only  poaaikla  through 
tha  tiralaaa  halp  and  motivation  provida  by  my  adviaor*  Col  Don 
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towar  ^  Col  Caughlin,  and  for  bia  aaaiatanca  aa  my  reader.  X  thank  both 
mambara  of  my  coomittaa  for  their  auparhuman  reatraint  in  not  equating 
tha  fuaay  logic  uaad  in  tha  theaia  to  any  of  my  thinking  procaaaaa. 

Tbanka  to  all  my  fallow  oST'a  and  COR* a  for  their  concern  in  my 
prograaa,  and  to  Capt  Scott  Ooahring  for  carrying  me  in  CM  XI  wnila  X 
worked  frantically  on  finiahing  my  tbaaia. 

A  vary  apacial  tbanka  to  my  wonderful  wife  Nary.  She  haa  bean  tha 
rock  wherein  X'va  found  my  aanity  during  the  laat  aix  montha.  Bor 
otrangth  baa  ra-enargized  mo  when  X  thought  X  waa  bopolaaaly  bogged 
down.  She  baa  given  mo  tha  energy  and  motivation  to  kaap  going. 
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Abstract 

ruBzy  logic  Is  used  for  sat  point  determination  in  a  linear 
quadratic  tracking  problem  for  the  O.S.  Air  Force's  C-18  Cruise  Missile 
Mission  Control  Aircraft  (CMMCA).  The  CMMCA's  mission  is  to  radar  track 
cruise  missiles  (CM)  during  test  flights.  Because  of  the  coiq;>lcxity  of 
the  CM  flight  profiles,  maintaining  radar  coverage  at  all  times  is  very 
difficult.  A  simulation  was  constructed  to  develop  fussy  logic  and 
optimal  controls  to  provide  lOOt  radar  coverage.  The  fussy  logic  was 
used  in  a  series  of  intervals  to  determine  the  set  point.  The  set  point 
calculation's  fussy  logic  balanced  CMMCA  maneuvering  based  on  present 
and  future  CM  positions.  Three  different  future  times  were  usedt  60,  90 
and  120  seconds  ahead,  and  the  performance  for  each  time  was  compared. 
The  final  form  of  the  fussy  logic  provided  vaarying  radar  coverage  at 
each  look  ahead  time  for  a  oacplex  CM  flight  path  (CM  in  20  degrees  of 
bank)  1850  seconds  long.  At  120  seconds  look  ahead  time,  the  coverage 
waa  100%.  When  the  same  profile  was  performed  with  the  CM  in  30  degrees 
of  bank,  coverage  wae  degraded,  end  CO  seconds  look  ahead  performed 
best. 
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h  FUZZY  LOGIC  OPTIMAL  SOLUTION  TO  THE 


CMMCA  TRACKING  PROBLEM 

J.  Introduction 

1 .  J  eacJtgrouad 

Thtt  O.S.  Air  Force  currently  uses  a  lar^ra  nuniber  of  aircraft 
during  each  cruise  missile  (CM)  teat  flight.  To  reduce  the  number  of 
required  aircraft,  the  Air  Force  Introduced  the  C-16  Cruise  Missile 
Klsalou  Control  Aircraft  (CMMCA) .  The  CMMCA  Is  modified  with  an 
AM/AFO'*C3  alr-to-air  radar  similar  to  that  In  the  McOonnell-Douglas 
F-15.  The  CMMCA  Is  designed  to  completely  replace  all  other  aircraft 
currently  flown  In  support  of  each  CM  test  flight.  The  CMMCA' s  mission 
is  to  track  the  CM  for  Its  entire  flight,  ke«iplnc  the  CM  within  the 
radar  field  of  view  as  much  as  possible,  providing  continuous  telemetry 
recaption  and  deconfllctlng  the  airspace  from  any  Intruders. 

Prior  to  entering  the  test  range,  the  CM  and  CMMCA  fly  generally 
straight  paths  at  medium  altitudes.  During  tills  portion  of  the  flight, 
the  CMMCA  has  no  difficulty  radar  tracking  the  missile.  Dpon  entering 
the  test  range,  the  CM  descends  to  below  1000  feet  and  begins  a  long, 
elaborato  series  of  maneuvers  consisting  of  turns  in  all  directions. 

The  turns  are  usually  linked  by  short  straight  segments;  soma  turns, 
hotiever,  havo  no  straight  segments  between  them  (see  Figure  1). 

The  odsalle  flies  at  a  nearly  constant  speed  of  400  knots 
(nautical  miles  (nm)  per  hour),  while  the  CMMCA  can  vary  its  speed 
between  320  and  480  knots.  Botievec,  because  speed  changes  result  in 
greater  fuel  consvunption,  the  CMMCA  should  fly  as  close  to  a  constant 
airspeed  as  possible.  The  CMMCA  has  an  operational  limit  of  30  degrees 
of  Lank,  as  wall  as  a  aiinlmum/maximum  "g"  capability  of  3/4  to  2  g's. 
Ixceeding  any  of  these  limits  can  put  excessive  stresses  on  the 
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rigor*  1  Cruiae  Misaila  Profiles 

airframe.  Although  the  CM  is  capable  of  large  bank  angles,  during  test 
flights  it  generally  turns  at  smaller  bank  angles  of  15-20  degrees. 

The  CMKCA  radar  field  of  view  is  a  cone  centered  on  the  fuselage 
and  60  degrees  to  either  side  of  center.  The  minimum  range  is  5  nm  and 
maximuu  rang*  is  IS  nm  (see  Figure  2).  The  CMMCA  attends  to  fly  a 
nculnal  distance  Vq  in  trail  of  the  CM  (directly  astern)  with  the 
otisslle  at  the  12  o'clock  position.  Although  the  value  of  Cq  is  not 
critical,  the  initial  value  used  will  be  a  slant  rang*  of  10  nm  (the 
center  of  the  radar  envelope).  Similarly,  the  nominal  look  angie  (angle 
frcei  th«l  nose  of  the  CMMCA  to  the  CM)  will  be  aero  degrees  in  azimuth. 

i 

1,1,1  PoBBiblm  jraneuvers  ot  the  CtUCA.  Several  factors  conspire 
to  cosqpllcate  this  problem.  They  include  the  restricted  radar  envelope 

i 

of  the  CMMCA  and  the  large  spacing  of  the  two  vehicles  relative  to  their 
turn  radii. 

As  SMn  as  the  missile  begins  an  extnnded  turn,  the  CMMCA  is  out 
of  position  and  must  maneuver  to  return  to  position.  The  CMMCA  can 
continue  to  follow  the  same  ground  track  as  the  missile,  can  follow  the 
sdsaile  until  losing  radar  contact  and  then  turn  blindly  toward  the 
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■Issil*,  or  follow  by  pointing  diroctly  at  th*  missilw. 

•uppos*  tti*  miasil*  makss  a  180  d*gr**  turn  and  th*  CMMCR  fli*s  as 
olo**  aa  possibl*  to  th*  CM  flight  peth.  Radar  contact  will  b*  lost 
after  th*  CKNCR  has  flown  8.S  nsi  and  r*aoquir*d  at  13.5  nm,  at  a  rang* 
of  11.2  nsi  (a**  rigur*  3a).  Xf  instsadr  th*  CMKCA  continues  straight 
ahead  until  nearly  losing  radar  contact,  then  flies  its  best  turn 
through  180  degrees,  radar  contact  will  be  lost  after  6.5  nm  and 
reacquired  at  11.0  nm,  barely  outside  minimum  rang*  (see  Figure  3b). 

Mow  suppose  the  OOICR  sia^ly  points  at  the  CM  «d)il*  the  missile 
SMKes  a  180  degree  turn.  The  distance  bettreen  the  two  will  decrease  and 
the  angle  between  their  headings  will  increass  until,  after  the  CMMCR 
has  flown  8.5  nm,  it  loses  radar  contact  at  minisnim  rang*.  Xf  the  CMMCA 
then  flies  its  tightest  turn,  it  will  still  not  reacquire  the  missile 
for  another  sir  am.  Xastead  of  beiitg  at  r^,  the  CMMCA  will  be  at 
minimum  range,  only  five  idles  in  trail  (see  Figure  4). 

Th*  CMMCA  can  also  change  its  airspeed  in  an  attnnpt  to  oiaintain 
radar  oorerag*.  Doing  so  will  allow  th*  CMMCA  to  follow  th*  sdssil* 
gjround  track  because  of  its  reduced  turn  radius,  but  th*  adssil*  may 
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rignr*  i  homt  of  Radar  Covarayo  During  Cruisa  Miaiila  Tuma 
(a)  CMMCr.  rollows  Kissila  ground  Track,  (b)  caOiCA  Bagins  Turn  at 

Radar  JUinmtti  Limit 

still  fly  out  of  tha  radar  covaraga.  Tba  major  raason  for  minimising 
airspaad  changas  is  bacausa  of  tha  affacts  on  CMMCA  fual  consumption. 
Anotbar  important  reason  is  that  it  is  simplar^  fastsr  and  mora 
affioiant  to  inoraasa  or  daoreasa  CMMCR  to  CM  spacing  by  turning  rathax 
than  by  changing  airspsad.  Bowavar,  if  tba  CM  spaads  up  or  slows  down 
for  an  axtandad  psriod  of  tiiDs,  than  tha  CMMCA  will  probably  uaad  to 
ehanga  spaad  also. 

Anothar  eoo^lication  rasults  if  tha  CMMCA  attacks  to  mtmad-etf 
and  lat  tha  CM  manauvar  wall  in  front  of  it,  bacausa  tha  CMMCA  must 
graatly  inoraasa  its  ranga  or  turn  wall  away  to  avoid  ovarflying  tha 
■iasila.  Bacausa  tha  CMMCA  will  covar  ovar  16  nm  wbila  tha  CM  axacutas 
a  slngla  turn  of  360  dagraas,  and  tha  span  of  minimum  to  mastmum  radar 
ranga  is  only  5  to  15  nm,  tha  CMMCA  will  almost  eartainly  loss  radar 
eovaraga  4uring  tha  missila's  manauvaring.  Noraovar,  raaehing  a  stand¬ 
off  position  and  rasuming  track  aftar  tha  stand-off  is  ocaplata  arc 


4 


rigor*  4  Los*  of  Radar  Covarage  whan  CHHCA  Pointa  Diractly  at 
Missll*  as  tong  as  Possibla 

fomidabl*  problams  that  ar*  mors  aaslly  avoided  by  lass  complicated 
CMKCA  flight  paths. 

Ou*  to  its  recant  acquisition,  the  pilots  and  crew  of  th*  <9(KCA 
bav*  not  yet  workad  out  robust  procedures  and  techniques  for  solving  th* 
tracking  problem,  nor  is  help  available  in  th*  form  of  autopilot  or 
other  control  methods.  In  fact,  pilots  still  rely  on  trial  and  error, 
experience,  and  luck  to  follow  the  CM  through  its  convoluted  and 
elaborate  flight  profile. 

Three  attempts  have  been  mad*  so  far  to  solve  th*  CNKCh  tracking 
problem.  Heavnar,  in  his  MS  thesis,  applied  dynamic  programming  to  th* 
CMNCA,  but  was  only  able  to  work  out  optimal  solutions  for  a  single 
nail  turn.  The  complexity  was  too  great  for  larger  flight  paths,  and 
coB^uter  msBtory  was  rapidly  exhausted  (8(36-38). 


Oarton  approachad  tha  CKKCA  problam  from  a  dlffarant  diractioai  ba 


trrota  a  Fortran  baaed  almulation  using  gradient  search  tachniguas  to 
mintmlsa  a  penalty  function,  anO  an  initial  straight  and  level  flight 
path.  The  penalty  function  incorporated  variable  weights  and  penalized 
deviations  of  the  CM  from  the  center  of  the  CHMCA's  radar  coverage. 
Although  performing  %«ell  for  simple  maneuvering,  the  most  cotsplex 
maneuver  considered  by  Oarton  was  a  single  270  degree  turn  with  the  CM 
in  only  20  degrees  of  bank.  (6t48-9).  '' 

Bachman's  thesis  was  an  extension  and  refinement  of  Oarton 'a  urorfc. 
Be  modified  the  penalty  function  by  adjusting  the  lighting  constants, 
and  tried  several  dift«ient  initial  CMMCA  flight  paths.  Be  then  used  a 
gradient  seaxch  procedure  to  produce  optimal  weightings  for  the  penalty 
function.  Bachman  achieved  good  results  in  most  cases,  although  ho 
still  didn't  achieve  completely  feasible  CMMCA  flight  profiles  (7t62). 

1,2  JPurpose  of  the  JtesearcA 

CMMCA  pilots  require  the  means  to  continuously  radar  track  the  CM. 
Previous  research  on  this  subject  has  provided  only  partial  answvcs. 
These  answers  apply  either  to  very  small  portions  of  the  flight  profile, 
or  extend  to  larger  portions  but  with  gaps  in  the  radar  coverage.  Also, 
these  earlier  results  only  provided  pilots  with  optimal  or  near  optimal 
CMMCA  giround  tracks  for  specific  missile  profiles.  They  did  not  provide 
control  laws  that  could  be  used  to  track  a  general  profile.  The  intent 
of  this  thesis  will  be  to  formulate  basic  control  laws  that  will  provide 
a  swans  for  the  CMMCA  to  track  the  CM  through  all  phases  of  its  flight, 
swintain  100%  radar  coverage,  and  not  exceed  the  operating  limits  of  the 
CMMCA. 

1.3  Problem  Statement 

Cruise  Missile  (CM)  test  flights  require  the  CMMCA  to  maintain 
constant  radar  contact  on  the.  CM  while  not  exceeding  aircraft  limits. 
Bowevar,  no  method  exists  to  provide  guidance  and  control  information  to 
the  CMMCA.  This  thesis  will  derive  optimal  control  laws  for  the  CMMCA 
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that  provide  maxinum  radar  coverage  and  remain  within  operational 
llaita. 

1.4  AMBumptlona  and  Scopm 

Several,  asaumptlona  and  llmitatlona  are  required  In  thla  theele  to 
narrow  tue  scope  and  complexity.  They  aret 

1.  The  equations  of  state  and  motion  are  based  on  a  flat,  non¬ 
rotating  earth. 

2.  Control  la«rs  are  determined  using  a  continuous-discrete  model. 
CMMCA  and  CM  movements  are  calculated  In  discrete  time  Intervals  of  one 
second.  Mlthln  each  time  Interval,  the  calculations  ara  carried  out  In 
continuous  time  based  on  the  eystem  state  at  the  beginning  of  the 
interval.  Chapter  2  has  a  detailed  explanation  of  this  modal. 

3.  The  CM  Is  at  a  constant  speec  of  400  knots  for  the  entire 
flight. 

4.  The  CM  Is  in  level  flight,  although  Its  altitude  actually 
varies  somewhat  as  It  follows  land  contours. 

5.  The  CMMCk  Is  level  at  29,000  feet. 

6.  Mo  attempt  was  mads  to  use  exact  performance  figures  for  the 
CMMCA  or  CM.  Instead,  the  analysis  uses  nominal  values  for  CMMCA  and  CM 
performance  and  limitations,  taken  from  the  previous  works. 

7.  The  CMMCA  is  restricted  to  bank  angles  less  than  30  degrees. 

8.  The  CMMCA' s  true  airspeed  (TAS)  is  held  constant  at  400  knots. 

9.  CMMCA  and  CM  are  unaffected  by  winds  or  other  atmospheric 
effects. 

10.  The  CMMCA  is  always  in  coordinated  flight  (no  sideslip) . 

11.  CM  flight  path  data  is  assumed  to  consist  of  map  coordinates 
only.  Mo  CM  heading  or  start/stop  turn  point  information  is  used.  All 
CM  maneuvers  have  been  simplified  to  straight  lines  and  circular  arcs. 

12.  All  CMMCA  and  missile  parameters  and  states  are  considered 
exact  rather  than  stochastic  (i.e. ,  no  random  errors  in  observations  and 
no  process  noise). 
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13.  The  caoiCA  radar  field  of  vla«'  r.a  a  cone  centered  on  the 
fuselage  and  60  degrees  to  either  side  oi  cen':er.  The  mininuni  range  is 
5  nm  and  masinnim  range  is  15  nm. 

14.  Radar  performance  is  uniform  throughout  the  entire  region  of 
coverage. 

15.  Both  vehicles  are  modeled  as  a  point  mass. 

16.  Future  knowledge  of  the  CM  flight  path  is  perfect. 

All  depictions  of  ground  tracks  throughout  this  thesis  will  be  ttio 
dimensional  for  ease  of  interpretation.  However,  the  three  dimensional 
slant  range  and  radar  look  angles  %mre  actually  used  in  all 
calculations. 


XJ.  Literature  Review 


2.1  Introduction 

Aircraft  and  aiaaila  guidance  and  control  haa  received  a  great 
deal  of  attention  in  the  previous  half  century r  The  subject  covers  a 
broad  range  of  topics  from  air-to-air  combat  to  a>xssile  and  airplane 
intercepts.  The  field  of  guidance  and  control  .ilso  extends  to 
rendexvous  on  other  aircraft  and  to  tracking  problems,  where  one 
aircraft  follows  another  at  some  specified  position. 

The  purpose  of  guidance  and  control  is  to  generate  some  type  of 
rendexvous  or  intercept  with  a  second,  possibly  maneuvering,  aircraft 
(the  target).  The  problem  is  how  to  best  apply  control  inputs  to  the 
controlled  aircraft  (the  pursuer).  Zn  many  cases,  the  desired  outccHoe 
is  to  bring  pursuer  and  target  close  enough  for  the  pursuer  to  employ 
its  weapons/ordnance.  Zn  the  case  of  rendexvous  and  tracking,  however, 
target  destruction  is  not  normally  a  goal.  For  a  rendexvous,  the 
pursuer  attends  to  arrive  at  the  same  position  as  the  target  and  at  the 
sane  velocity.  For  tracicing,  when  defined  for  controlling  one  aircraft 
with  respect  to  another,  the  pursuer  attempts  to  maintain  some 
predetermined  position  relative  to  the  target. 

The  CMMCA  control  problem  is  fundamentally  a  tracking  problem. 
Therefore,  for  this  thesis  the  scope  will  be  limited  to  those  problems 
where  the  objective  is  to  maintain  a  position  relative  to  the  target. 

The  term  tracking  will  be  synonymous  throughout  with  CKHCA  tracking, 
i.e.  with  the  CMMCA  maintaining  a  preset  position  a  nominal  distcnce  in 
trail  of  the  CM.  This  definition  is  a  very  narrow  definition  of  the 
normal  ateaning  of  trac)cing,  and  is  adopted  here  to  prevent  having  to 
invent  a  new  term  for  the  CMMCA  tracking  problem. 

Although  there  is  a  vast  amount  of  ouiterial  available  discussing 
missiles  intercepting  aircraft,  the  literature  is  much  sparser  for 
rendesvous  problems,  and  nearly  silent  when  it  comes  to  tracking.  Any 
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Investtgatlon  of  the  caofCA  tracking  problam  must  bagin  with  a  raviaw  of 
tha  lltaratura  concarnlng  intercapt  and  tracking  problams. 

Spaclflcally,  this  proposal  axaalnas  dynaolc  prograamlng,  penalty 
function  mothods,  differential  game  theory,  and  optimal  control  theory. 

2.2  Dynamic  Programming 

An  approach  that  Is  scaMtimas  useful  for  this  class  of  problem  Is 
known  as  dynamic  programming  (DP).  According  to  Winston,  OP  "obtains 
solutions  by  working  backweurd  from  the  end  of  a  problam  toward  the 
beginning,  thus  breaking  up  c  large  unwieldy  problam  into  a  series  of 
smaller,  more  tractable  problems"  (19i715).  Dynamic  programming  is  an 
easily  implemented  approach,  however.  It  has  severe  known  llmltatlonai  a 
linear  Increase  In  problam  size  causes  an  exponential  Increase  In 
complexity.  It  Is  highly  ccmputar  Intensive,  even  with  small  problams. 
Haavner  ran  Into  exactly  this  problem  In  his  DP  Implementation  of  the 
dMCA  problem  (8t36).  Winston  states  the  five  basic  principles  of  DPt 

1.  The  problem  can  be  divided  Into  stages  with  a  decision  required  at 
each  stage. 

2.  lach  stage  has  a  number  of  states  associated  with  It. 

3.  Bach  decision  transforms  the  current  state  into  the  next. 

4.  The  optimal  decision  for  each  stage  must  not  depend  on  previously 
reached  states  or  previously  chosen  decisions. 

5.  There  Is  somo  coat  function  to  be  mlnlmlzed/maxlmized  that  depends 
only  on  the  states.  (19i722) 

The  term  stage  In  moat  cases  refers  to  the  discrete  time  intervals 
Into  which  the  problem  Is  broken.  The  state  is  the  full  set  of 
information  needed  at  each  stage  to  make  the  correct  decision.  The 
state  is  often  the  position  and  velocity  of  each  aircraft,  hotfover,  the 
choice  of  states  is  arbitrary  since  there  is  an  infinite  number  of 
states  that  lead  to  the  same  result  (9<53).  Xn  practice,  the  states  are 
chosen  to  make  the  problem  sisqpler. 

DP  is  especially  applicable  to  the  discrete  time  quadratic 
regulator  problam.  Por  this  problem,  the  linear  system  is  given  by  the 
state  equation! 

+  Bu(t,^),  X(to)  ■  Xq 
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whar*  h  and  B  ara  matricas,  x(t|^)  is  tha  atata  vactor  at  tima  t|^, 
is  tha  control  at  time  t|^,  and  Xq  is  tha  initial  condition.  Tha  problam 
ia  to  find  u(t|j)  that  minifflisaa  tha  cost  J,  whara 

a-t  a-t 

J  -  x(t|,)  Pf  x(t|)  ♦  r  Ix’'(ti)Ox(ti)]  +  zE  u*(ti) 

1>0  1>0 

Bara  a  suparscript  "T”  rapraaants  a  tranaposa  oparation,  and  P^,  Q  and  r 
ara  ralativa  waightinga  of  tha  coat  terms.  Pf  panaliaes  deviation  at 
the  final  time  t  «  t,^,  Q  panaliaas  deviation  from  the  daairad  atata 
during  the  time  interval  (tQ,t|,]  and  r  ia  tha  control  cost  (9i243-4). 

Baavnar,  in  his  KS  thesis,  applied  DP  to  the  CKMCA  by  using  time 
intervals  of  6  seconds  and  a  four-state  implementation  consisting  of  the 
CKKCA's  position  and  velocity.  Be  used  CMMCA  bank  angle  and  thrust  as 
control  variables  (tha  inputs  to  tha  system).  Be  than  related  tha  state 
of  tha  CMMCh  at  tha  next  tima  period  to  its  state  at  tha  currant  time 
period  plus  tha  change  caused  by  tha  controls  (8<18). 

Baavnar  minimised  a  cost  functional  based  on  CM  deviations  from 
tha  canter  of  tha  CMMCh's  radar  coverage.  Instead  of  a  quadratic  cost, 
his  cost  had  the  form 

J  -  J^‘L[X(t),U(t)]dt  ♦0[X(t,),tj]  (1> 

where  L  penalised  tha  sum  of  range  and  asimuth  deviations  during  the 
flight,  and  O  penalised  missile  deviations  during  tha  end  game 
(8il9,72).  Baavnar  discretized  J  by  converting  the  integral  to  a 
summation  and  explored  several  different  time  steps. 

Baavnar 's  results  were  limited  to  CM  maneuvers  of  a  single  turn  of 
90  degrees  or  less.  Coaqsiter  memory  requirements  increased  so  rapidly 
that  the  solution  soon  became  impossible,  a  problam  noted  by  Ninston 
(19t754).  Baavnar  further  reported  that  the  results  were  highly 
depundent  on  the  tima  interval  used,  and  suggests  that  his  penalty 
function  could  bo  significantly  in^roved  (8 t 37-8). 
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2.3  Penalty  fuactioa  Mmthod  (Optlaugatlou) 

Garton  applied  a  penalty  function  tc  the  CMMCA  tracking  problem. 
That  is,  he  used  the  form  of  equation  1,  but  with  a  significantly  more 
sophisticated  penalty  function.  Instead  of  simply  summing  the  range  and 
axunuth  deviations,  as  Heavner  did,  Garton  used 

m 

JCV»«1  •  Ji 

i*0 

Ji  -  (r(ti)  -ro]»  ♦  W,[e(ti)-  -  W,  +  W, 

where  N  is  the  number  of  time  intervals,  r(t)  and  d(t)  are  the  range  and 
axiffiuth  from  the  CMKCk  to  the  CM  (rg  and  6g  are  their  nominal  values),  V 
and  a  are  the  velocity  and  bank  angle  of  the  CMMCh  (Dg  is  the  nominal 
velocity),  through  ¥^,  p,  Kj,  and  ue  weights  to  be  determined,  and 
the  Wt^  are  quadrature  integration  weights  (6t 19-23). 

Garton  calculated  J  based  on  an  initial  (guessed)  CMMCA  flight 
path.  Bis  starting  flight  path  was  for!  the  CMMCk  to  fly  straight  and 
level.  Be  then  used  a  gradient  search  procedure  to  reduce  J.  To 
compute  the  gradient  of  J,  be  first  formed  a  maneuver  vector  consisting 

of  the  CMMCA  speed  and  bank  angle  at  ea^h  time  interval  (a  2H  x  i 

I 

vector).  Be  than  calculated  the  gradient  from  the  partial  derivatives 
of  J  with  respect  to  speed  and  bank.  Be  sampled  three  J  values  along 
this  gradient  and  fit  a  parabola  to  the  points,  then  found  the  minimuffl 
of  this  parabola.  This  became  his  next  maneuver  vector,  and  the  process 
repeated  until  J  converged  to  a  adnimum  (6t24-33).  • 

Garton  successfully  applied  this  method  for  the  CM  straight  and 
level,  and  for  the  CM  in  20  degrees  of  bank  for  a  90  degree  turn.  When 
applied  to  a  CM  turn  of  270  degrees,  Ixswever,  the  algorithm  exceeded  the 
CMNCA's  bank  angle  restriction  (6i43-49). 

Bachman  started  with  Garton ’s  algorithm  and  scaled  the  penalty 
function  components  so  that  any  deviation  of  the  same  magnitude  produced 
the  same  penalty  (7i28-30).  Be  used  two  initial  CMMCA  flight  pathst 
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1)  straight  and  loval,  tha  saoa  as  Oarton,  and  2)  tha  CiMMCh  flying 
sxactly  the  sams  flight  path  as  tha  CM  at  tha  dasirad  distanca  bahind 
tha  nissila.  Bachman  also  sat  all  paramatars  to  Carton's  computad 
valuat,  and  sat  tha  weighting  factors  to  ons.  Bachman  usad  four  CM 
^profilasi 

1.  a  169  degraa  turn. 

2.  a  279  daqraa  turn. 

3.  a  270  dagraa  turn  to  tha  right,  followad  inmadiataly  by  a  270 
dcigraa  turn  to  tha  lafc. 

4.  an  actual  taat  flight  fragmant  with  sovac  straight  jagmants 
fjod  six  turns  of  batwaan  45  and  200  dagraas  (saa  Pigura  5)  (7i 30-35}. 


Pigura  5  Tha  Pour  CM  Profilas  Dsad  by  Bachman  (5 t 31-35) 


Bachman's  rasults  ara  shown  An  Tabls  1.  Profilas  ona  and  two  mat 
all  CMMCA  constraints  and  achiSTsd  100%  radar  covaraga.  Profilas  thraa 
and  four  both  showad  significant  dagradation  in  radu  covaraga  whan  tha 
initial  CMMCA  ground  track  was  straight  and  laval.  Khan  tha  CMMCA 's 
initial  path  was  in  trail  of  tha  CM,  tha  rasults  wara  naarly  optimal. 
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Sabls  1  Hachiaan's  Piraliininary  Rsaulta  for  Four  CM  Frofilas  (St 50) 


Flight  Path 

Initial  Path 

%  of  time  in 
CMMCA  Limits 

1 

Straight 

Trailing 

100 

100 

100 

100 

7 

Straight 

Trailing 

100 

100 

100 

100 

3 

Straight 

Trailing 

74.15 

94.56 

100 

100 

4 

Straight 

Trailing 

37s41 

100 

64.68 

97.90 

Bachman  than  Implamantad  a  2*  full  factorial  daaign  on  profile 
thraa.  Ha  usad  tha  thraa  weighting  factors  and  the  CMMCM  to  CM  nominal 
range  r^  as  his  design  paramaters  in  an  attempt  to  maximise  the  percent 
radar  coverage.  Bis  intent  was  to  produce  a  sat  of  optimal  weights  and 
an  optimal  nominal  range. 

The  factorial  design  prucaaded  by  selecting  2^  design  points,  each 
with  a  different  combination  of  weights  and  rp.  A  linear  regression  was 
performed  on  tho  results,  producing  a  first  order  response  marfmem.  The 
gradient  of  this  surface  was  taken  at  its  bast  <but  still  suboptimal 
point).  An  examination  of  tha  responses  along  the  gradient  from  this 
point  was  used  to  find  a  local  maximum.  This  local  maximum  was  then 
used  as  the  center  for  another  set  of  design  points. 

This  search  procedure  was  iterated  through  two  gradient  searches. 
Bachman  discovered  on  the  second  gradient  search  that  he  was  finding  no 
isvrovamsnt  in  radar  coverage  <the  response),  and  tberefose  he  stopped. 
Be  selected  as  optimal  that  set  of  weights  that  had  given  him  the  best 
response.  (7 t 38-40,49-55) . 

This  point  of  the  gradient  search  on  profile  three  was  to  provide 
optimal  weights  that  could  than  be  applied  to  profile  four.  This  did, 
if  fact,  allow  Bachman  to  achieve  good  results  for  CM  profile  four.  The 
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radar  covaraga  improved  from  63%  to  100%  and  caoiCA  limits  %#ara 
maintainad  at  98%. 

Bachman  tried  two  other  methods  to  improve  profile  four's  results. 
Be  first  triad  double  precision  variables,  which  resulted  in  an 
improvement  of  about  1%  in  CMMCA  limits  with  no  loss  of  radar  coverage. 
An  extreme  drawback  of  this  method  was  that  each  run  required  nearly 
seven  hours  of  CPU  time  on  a  VAX  modal  6420  computer. 

Bachman  reported  his  best  success  came  from  breaking  the  profile 
into  ttK)  pieces,  roughly  equal  in  length.  In  this  case,  no  change 
occurred  from  the  CMMCA  in  a  trailing  initial  position,  but  the  straight 
and  level  initial  position  improved  greatly  (see  Table  2)  (7i56-9). 

Sable  2  Bachman's  Results  for  CM  Profile  Pour  OsXng  Three  Different 

Approaches  (5tS6,57,S9) 


Kethod 

Initial  Path 

%  Radar 

Coveraoe 

%  of  time  in 
CMMCA  Limits 

Optimal  Weights 
From  k<rofilo  3 

Straight 

Trailing 

53. 8S 

100 

100 

97.9 

Double  Precision 
Variables 

Straight 

Trailing 

46.15 

100 

100 

98.25 

Splitting  Flight 
Path  into 

Two  Seoments 

Straigtt 

Trailing 

97.55 

100 

100 

97.67 

Bachman  found  several  major  difficulties  with  bis  method.  The 
as»unt  of  CPU  time  increased  rapidly  as  CM  profiles  grew  longer. 
Profile  four  took  approximately  three  hours  for  one  run  (of  ISO 
Iterations).  Khen  split  into  two  pieces,  each  piece  still  took  SO 
minutes  of  CPU  tims  <7tS9). 

Another  major  problem  Bachman  found  was  difficulty  in  achieving 
oonvergence  of  the  gradient  search  technique  to  minimise  the  penalty 
function  (7t65).  This  was  part  of  the  cause  of  the  significant 
increases  in  computer  time  required  to  find  the  optimal  trajectory. 
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Xn  ■uamary,  Bachman's  method  requires  a  starting  CSKMCA  flight 
path,  which  is  rurrently  produced  by  guesswork.  The  number  of 
iterations  to  ^iroduce  a  minimvm  penalty  function  is  large,  and  time 
required  appears  to  increase  exponentially  witn  CM  flight  path  length. 
Worst  of  all,  the  output  from  this  method  is  simply  a  ground  track  for 
the  CMMCA  to  follow.  The^e  is  no  way  to  implement  this  form  of  the 
solution  by  autopilot  or  to  use  the  actual  aircraft  data  such  as  range 
and  bearing  to  the  missile. 

2.4  Ditfmrmntiil  Oaoe  Theory 

Two  player,  soro-sum  games  are  those  in  which  two  competitors  are 
engaged  in  a  contest  that  defines  a  winner  and  a  loser.  Games  in  which 
the  movestents  of  the  players  can  be  described  by  differential  eqi'ations 
are  known  as  differential  games.  Air  combat  involves  two  adversaries 
maneuvering  witn  the  offensive  adversary  (pursuer)  attempting  to  shoot 
down  the  defender  (target) .  The  arena  of  air-to-air  engagements  between 
pursuer  and  target  is  an  example  of  a  two  player,  sero-sum  differential 
game. 

Bryson  and  Ho  discuss  linear-quadratic  pursuit-evasion  games 
(lt282-289).  The  mathematical  basis  of  all  differential  games  is  the 
Maxiimim  Principle.  Pursuer’s  and  evader's  equations  of  motion  arei 

*p  “  Vp  S'*'  *p(to) 

*,  -  P.X,  +  O.v,  given 

trtiere  the  subscripts  p  and  a  represent  pursuer  and  evader,  u  and  ▼ 
the  pursuer's  and  evader's  control  inputs,  and  F  and  G  are 
relating  the  change  of  state  to  the  current  state  and  controls. 

Menon  considered  the  problem  of  two  aircraft,  one  strictly 
offensive  and  the  other  strictly  defensive  (13(27-28).  The  goal  of 
pursuer  is  to  drive  the  distance  between  them  to  sero,  triiile  the 
defender  seeks  to  maximise  the  distance.  With  O  and  W  the  pursuer’s 
defender's  pmmudo-contsol  inputs,  respectively,  Z  the  relative  posit 
between  pursuer  and  defender,  8  a  positive  semidefinite  matrix 
penalising  separation  at  the  final  time  t^,  and  A  and  B  positive 
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d*finit«  Mtricca  rapraaanting  ace«l«ratlon  capabilitias  o2  tha  purouar 
aitd  dafandar,  raspactivaly,  than  tha  coat  functional  la 

J  .  ndn  max  2(t,)  *  [U*AU  -  W’^BW] dt) 

(13 I 29).  Tha  purauar  attaopta  to  minlmiaa  tha  coat  of  manauvaring  whila 
drlTlng  tha  ranga  to  aaroi  convaraaly,  tha  targat  attampta  to  miniffliza 
tha  coat  of  nanauvaring  tdiila  trying  to  in'^raaaa  tha  ranga  aa  much  aa 
poaaibla. 

0  and  N  ara  paaudo-controla  bacauaa  thay  ara  obtainad  by 
tranaforming  tha  actual  .aircraft  controla,  (i.a.,  throttlaa,  "g'a,"  and 
bank)  into  thair  componanta  in  inartial  3->apacc.  Thia  alao  haa  tha 
affact  of  tranaforming  tha  nonlinaar  vahicla  dynamica  into  a  linaar, 
ttma  InTariant  fora.  Nanon'a  modal  ia  formulatad  in  tarma  of  tha 
inartial  poaition  atata  rariablaa  and  thair  varioua  darivativaai  tha 
aolution  obtainad  ia  in  a  faadback  form,  kftar  foradng  tha  Hamiltonian, 
Manon  uaaa  tha  variational  calculua  to  dariva  a  cloaad  form  aolution  of 
tha  control  lawa.  Tha  invaraa  tranaformation  raaulta  in  a  non-linaar 
fbadback  aolution  in  tha  original  coordinataa  ( 13 i 37-29). 

j  Manon  raporta  raaulta  for  two  acanarioa.  Both  involva  fightar 
t]rP*  aircraft  of  naarly  aqual  capabilitiaa.  Zn  tha  firat,  tha  avadar  ia 
aucoaaafully  intarcaptad  in  14.5  aaconda.  Zn  tha  aacond  acanario,  tha 
purauar  faila  to  intaroapt  and  tha  avadar  aacapaa  ( 13 t 30-3). 

Zncluaion  of  a  waapon'a  ranga  makaa  an  air-combat  modal  avan  mora 
rmaliatic,  and  can  ba  accompliahad  by  aaauming  a  apharical  %raapona 
anvalopa  of  radiua  R^.  ka  aoon  aa  tha  diatanca  batwaan  tha  playara 
dmotmaaaa  to  tha  problam  ia  aolvad  and  tha  targat  ia  daaa»d 
daatroyad. 

Manon  4  Du)ca  daviaad  an  avan  mora  raaliatic  waapona  anvalopa  that 
took  tha  form  of  an  arbitrary  3-dlmonaional  abapa.  Thay  atartad  with 
Moooa'a  modal  daacribad  abova  and  than  axpandad  it  by  incluaion  of  an 
arbitrary  waapona  anvalopa.  Thay  cita  aiopla  azamplaa  auch  aa  a  cona  of 
limitad  aiaa  dlraotly  forward  of  tha  purauar,  and  a  prolata  apharoid 
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<footbftIl  ahap*)  cantarad  at  tha  purauar'a  oentar  of  maaa  (14t449-450) . 
Tha  cona-ahapad  vfaapona  anvalopa  ia  vary  aimilar  to  tha  CMMCA'a  radar 
covaraga. 

An  additional  factor  in  intarcapt  problama  ia  tha  apecification  of 
tha  final  tima  —  tha  tiaa  at  which  tha  intarcapt  occura.  Final  tima  ia 
a  critical  valua;  variationa  can  aignificantly  changa  tha  outcona  of  tha 
intarcapt  or  randasvoua.  Manon  and  Dulca  %Mira  abla  to  laava  final  tima 
unapaoifiad,  than  dariva  it  from  tha  aquationa  of  motion  and  from  anargy 
conaarvation  lawa  (14t453). 

Aa  in  Hanon'a  aarliar  papar,  variational  calculua  ia  appliad  to 
tha  Hamiltonian  aquation  to  dariva  a  cloaad  form  aolution  to  tha  control 
lawa.  Tha  aama  tranaformation  and  invaraa  tranaformation  ara  uaad  to  go 
from  tha  nonlinaar  dynamica  to  a  linaar  tima- invariant  form,  than  back 
to  tha  original  coordinataa  (14 t 451-3). 

Manon  and  Duka  raport  tha  raault  from  ona  angagamant  acanario.  Aa 
in  Manon 'a  papar,  both  aircraft  ara  fightar  typaa  of  naarly  aqual 
oapabilitiaa  axcapt  tha  purauar'a  top  apaad  ia  almoat  twica  tha 
avadar'a.  Tha  avadar  bagina  2  km  in  front  of  and  5  km  to  tha  right  of 
tha  purauar,  with  tha  avadar'a  haading  90  dagraaa  away  from  tha  purauar. 
Tha  avadar  bagina  a  turn  away  and  triaa  to  out  run  tha  purauar.  Tha 
purauar  bagina  an  immadiata  turn  and  ccmplataa  tha  intarcapt  aftar  51 
aaconda.  Tha  affaet  of  tha  waapon'a  anvalopa  can  ba  aaan  in  tha 
altituda  aecalaration  hiatory  of  tha  purauar,  whara  it  cauaaa  aavaral 
larga  oacillationa  (14i454-5). 

Oiffarantial  gama  thaory  ia  a  promiaing  avanua  of  approach;  ita 
aaaua^iona  ara  raaaonabla  and  tha  uaa  of  a  waapona  anvalopa  ia 
ramarkably  aimilar  to  that  of  tha  radar  anvironmant  in  which  tha  CMMCA 
oparataa.  Tha  major  dratH»ack  to  uaing  gama  thaory  for  tha  CMMCA 
tracking  problam  ia  axactly  ita  moat  baaic  faatura.  Tha  avadar  ia 
manauvaring  in  raaction  to  tha  purauar,  attaripting  to  maximiaa  ralativa 
ranga,  yat  in  tha  CMMCA  problam,  tha  CM  followa  a  praaat  eouraa. 
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2.5  Optimal  Control  Thaory 

Tb«  theory  of  optimal  control  has  bsan  developed  to  derive  a  set 
of  input  controls  to  drive  a  dynamic  system  in  some  optimal  fashion, 
that  is,  in  a  way  that  minimizes  a  cost.  In  the  linear  quadratic 
gaussian  formulation,  the  cost  is  based  on  a  performance  index  that  is 
defined  as  deviations  from  some  desired  state,  and  the  amount  of  control 
input  provided  to  the  system.  The  resulting  optimal  control  law  is 
easily  implamented  on  nearly  any  computer  and  the  results  are  rapidly 
available.  Further,  for  a  linear  system,  most  of  the  computations  can 
be  done  otf-lina,  that  is,  prior  to  actually  applying  them  to  the  system 
(10tS2). 

In  general,  a  syst«n  (plant)  cem  be  described  by  the  non-linear 
dynasiical  equation 

*(t)  «  f(x,u,t) 

where  x(t)  ie  an  n  dimensional  state  vector  and  u  is  an  m  dimensional 
control  input  vector.  Associated  with  the  system  is  a  performance  or 
cost  index 

J  -  ♦(x(tj),t*)  ♦  /^L(x{t).u(t),t)dt 

over  the  tims  interval  [t0,tf].  The  cost  •(x(tf),tf}  depends  on  the 
final  state  and  final  time,  while  the  weighting  function  L(x,u,t) 
depends  on  the  state  and  input  at  intermediate  times.  Optimal  control 
is  the  problem  of  finding  "the  input  u*(t)  on  the  time  interval  [tg,tf] 
that  drives  the  plant  along  a  trajectory  x*(t)  such  that  the  cost 
function*  is  minimized  (lOtlSl). 

Zn  many  oases,  the  plant  can  be  adequately  expressed  with  a  linear 
time-varying  system  of  equations 

*  -  A(t)x(t)  ♦  B(t)u(t)  (2) 

where  x  a  V  and  u  s  If. 
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Associatad  with  tha  syatam  is  a  quadratic  parfomanM  indax 
J  -  -i  x*(t,)S(t,)x(t,)  *  ~  [x»0(t)x  ♦u’R(t)uldt  (3) 

ovar  tha  tiioa  intarval  (t^«tf].  In  tha  moat  ganaral  fonsulationr 
"ifalgbtlnq  matrlcaa  S[tf)  and  Q(t)  ara  synsatrlc  and  positlva 
aamldaflnlta,  and  It(t)  la  ayomatric  and  poaitiva  dafinita”  (10 >180). 

Thla  ayatam  ia  an  axasqpla  of  a  llnaar-quadratic  (LQ)  raqulator. 

"A  raguiator  ia  daaignad  to  kaap  a  atationary  ayataa  within  an 
aecaptabla  daviation  froo  a  rafaranca  condition  uaing  accaptabla  amounta 
of  control*  (lil48).  Another  typa  of  ayatam  ia  tha  tmraiBtl  controller, 
which  ia  "daaignad  to  bring  a  ayatam  cloaa  to  daairad  eonditiona  at 
tarminal  tima  (which  may  or  may  not  ba  apacifiad)  while  exhibiting 
accaptabla  behavior  on  tha  way*  (It 148). 

Oaing  atata  and  coatata  aquationa  and  boundary  eonditiona,  the 
optimal  control  ia  axpraaaibla  in  tarma  of  A,  B,  and  Bowavar,  u* 

doaa  not  depend  on  tha  atata  x(t),  making  thia  an  open  loop  controller. 
If  aoma  perturbation  movaa  tha  ayatam  off  tha  predicted  couraa,  tha 
controller  will  not  coaqxmaata.  Banco  a  eloeed  loop  controller  that  can 
react  to  ayatam  parturbationa  ia  preferred. 

To  develop  a  cloaad  loop,  feedback  control  atruetura,  the  mathod 
of  Lagrange  multipliara  ia  often  uaad.  8tart  by  adjoining  tha  atata 
aquation  (2)  to  tha  control  coat  (3)  uaing  a  (vector)  Lagrange 
multiplier  l(t)  c  If*  (9>226'-7), 

J  -  -i  X*SX  ♦  t-yX'^Qx  ♦  iu^RU  ♦  l*^(Ax4’BU*dk)  Idt 

-  -Ia^Sx  ♦ /**  (H-A*±]dt 
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whttra  the  Hamiltonian  H  ia  defined  ae 


H  ■  [x*Qx  +  u’Ru]  ♦  X*(Ax  +  Bu) 

Oaing  reaulta  from  the  calculue  of  variations,  the  state  and  coatate 
equations  are  ( 10 i 180-181, 189-191) 

ik  ■  ^  Ax  ■*'  Bu 


-X  -  II  •  Qx  ♦  A^u 


and  the  stationarity  condition  is 


0  -  |5  -  Ru  ♦  b"^! 


(4) 


Solving  aquation  (4)  for  u(t), 

u(t)  -  -R‘Vl(t)) 

Further,  %m  must  have 

i(t^)  -  8(t,)x(t^) 

Mow  assume  this  same  relation  between  x(tf)  and  X(tf)  holds  for 
all  t  €  tVt,Ji 

i(t)  -  -S(t)  x(t) 

Xf  there  exists  such  a  matrix  6(t),  then  this  assuo^ion  will  have  been 
valid.  Differentiate  the  costats  equation  and  substitute  the  state  and 
coatate  equations  to  get  (dropping  the  explicit  time  dependence 
notation) 

1 

-Sx  -  (A»S  ♦  SA  -  SBR**B*S  ♦Ox 

and  since  this  must  be  true  for! all  t 

1 

-i  -  A*S  ♦  SA  -  SBR-^B'^S  ♦0.  tit. 
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This  is  tbs  matrix  Riccati  aquation.  Xf  tbs  Riecati  aquation  bas 
a  solution,  then  tbe  assumption  was  valid  and  tberafora  tba  optimal 
control  is 

u*(t)  -  -R"‘’B^Sx*{t) 

According  to  Kailatb,  tba  solution  to  tba  Riccati  equation  exists  and  is 
unique  if  tba  system  is  both  controllable  and  observable  (9t231). 
Defining  tbe  Kalman  gain  as 

K(t>  -  R"V8(t) 

the  optimal  control  is 

u*(t)  -  -K<t)-x*(t) 

The  Riccati  equation  is  solved  backwards  in  time  for  S(t).  Note  that 
this  can  ba  done  oti-linm,  since  the  state  x(t)  does  not  appear  in  the 
aquation.  Then  the  Kalman  gain  can  be  conqi^ted  and  stored,  to  be 
applied  later  (10il90). 

IJawis  discusses  several  other  results > 

1.  Sven  if  A,  B,  Q,  and  R  are  time-invariant,  K(t)  still  varies  with 
time. 

2.  The  plant  dynamics  ar-e 

A  ■  (A  -  BK)x 

Tor  any  initial  condition  x(tg),  this  will  yield  tbe  optimal  state 
trajectory  x*(t). 

2.  If  the  optimal  control  is  used  on  (t^,tf],  then  the  performance 
index  is 

J(t)  -  J|x^t)-S(t)-x(t) 

The  advantage  of  this  is  that  cost  can  be  ccn^ted  in  advance.  Xf  the 
cost  is  too  high,  tbe  weighting  jatrices  Q,  R,  or  B(tf)  can  be  changed 
(10tl91). 

Ooaqputers  are,  of  course,  used  to  solve  tbe  above  equations,  and 
tbe  digital  iiiq>lementation  Ittnds  itself  to  saaq>led  data  rather  than 
continuous  solutions.  Xn  the  discrete  version,  tbe  optimal  (Kmtrol  is  a 
piecewise  constant  function,  that  is,  changed  only  at  the  beginning  of 
each  discrete  time  step.  Tbe  continuous  equations  for  a  linear  time 


invariant  plant  (auch  aa  the  CMMCA)  are  easily  made  discrete 
(12t42,43;10t63-6S) .  The  interval  from  tQ  to  t^  is  divided  into  M 
periods  of  length  T  (the  sampling  period) .  The  plant  equation  becomes 

where  •  and  T,  the  sampled  plant  and  control  matrices,  are  given  by 

•  (tk^i.tk)  ■  e" 

r(tk.„tj)  - /'‘•‘•(tk.i.T)B{t)dt 
•*» 

This  is  the  continuoaa-dlacrotm  control  law  formulation.  The 
optimal  control  u*|^  is  discratet  constant  during  each  time  interval  and 
switched  to  a  new  value  only  between  steps.  u*|^  is  computed  from  the 
above  equations  for  the  optimal  gain,  bui  ising  the  sampled  matrices  in 
place  of  the  system  matrices.  The  state  x*(t)  is  continuous  and  is 
found  by  summing  over  all  complete  time  inta  -als,  .ind  integrating 
during  the  current  ones 

x(t)  •  e“*"*»*x(t,5)  ♦  j’^e^‘*‘’‘BdtUk ,  t^  s  t  < 

2,C  Fuaay  Logic  and  Taaay  Control  Systems 

2.6,1  Introduction.  Generally,  the  output  response  to  a  set  of 
inputs  is  derived  from  one  or  more  mathematical  equations,  from  a  set  of 
rules  (expert  system  or  Boolean  logic),  or  from  a  transfer  function. 

Many  times,  however,  the  resulting  algorithms  are  so  cooqplex  as  to  be 
eoa^letely  or  essentially  useless.  Applications  requiring  real  time 
solutions  may  not  have  a  solution  calculable  in  real  time  (e.g.  convex 
optlskisation  problems).  To  arrive  at  mathamatically  tractable,  real 
time  solutions,  it  is  ootmaon  to  make  sis^lifying  assumptions.  Doing  so, 
however,  often  means  that  the  resulting  errors  are  excessive,  rendering 
the  solution  unusable. 

russy  logic  is  a  way  around  these  difficulties,  and  is  often 
vastly  simpler  and  much  worm  intuitive.  Consider  the  fuxxy  rulet  ”Xf 
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brska  tempcratur*  i>  Want  AND  apead  la  Not  Vary  Vast,  than  braka 
prassura  is  Slightly  Oacraaasd"  in  a  car's  anti-lock  bcaka  systam  vs  tha 
convantional  focmulationt  "if  (  200  is  lass  than  bcaka  tanqparatura  is 
lass  than  280)  AND  (apaad  is  loss  than  45  RPM),  than  bcaka  pcossure  is 
190"  (St 58).  In  this  casa,  tha  dagroas  of  nan  and  spsad  will  datacmina 
tha  astoont  of  bcaka  prassura.  In  assenca,  this  ona  fussy  logic  cula 
supplants  nany  culas  in  a  convantional  cula-basad  systaa. 

According  to  Chiu  at  al.,  fussy  logic  control  has  "axcallant 
robustness  charactaristics,  parhaps  bacausa  tha  inharant  impracision,  or 
ganarality  ...  is  %foll  suited  to  imprecisa  systems  whose  behavior  is 
known  only  in  the  large"  (3t43).  Cox  IDcans  a  fussy  nodal  to  a  parallel 
processor  t  "All  tha  rules  that  have  any  truth  in  their  pranisas  will 
fire  and  contribute  to  the  output  fussy  set,"  i.e.  to  tha  control 
variablas  ( 5 1 60) . 

The  important  and  distinguishing  feature  of  a  fussy  rule  systaa  is 
its  reliance  on  human  axperianca  and  intuition.  A  fussy  control 
algorithm  "can  be  regarded  as  a  sat  of  heuristic  decision  rules  or 
'rules  of  thumb'"  (lli6S).  As  guidelines  for  whan  to  use  fussy  logic, 

Cox  suggests  I  "whan  ona  or  more  control  variablas  are  continuous;  when  a 
auithaaatical  modal  of  the  process  does  not  exist,  or  exists  but  is  too 
complex  to  be  evaluated  (rapidly  or  taJeas  up  too  much  chip  maaory]  ..., 
whan  high  ambient  noisa  levels  must  be  dealt  with,  ...;  and  parbapa 
above  all,  «riian  an  expert  is  available  who  can  specify  the  rules 
underlying  tha  s'-staa  behavior  and  tha  fussy  sets  that  reprasant  the 
characteristics  of  each  variable"  (5t58). 

2.6.2  FUMMy  5»tt.  The  concept  of  a  fussy  set  is  fundamental  to 
fussy  logic.  A  fussy  set  is  any  set  in  which  elements  may  have  in- 
baewsan  aambarship  in  that  set.  Unlike  normal  sets  where  an  element  is 
either  in  or  not  in  a  set,  an  element  may  belong  only  partially  to  a 
fussy  set.  Tha  dagrae  of  set  ssambarship  is  a  real  number  from  0  to  1 
with  0  denoting  no  mambership  and  1  representing  full  sat  mambersbip. 


With  the  notion  of  fussy  sets  in  liand,  the  next  step  is  to 
consider  each  variable.  Li  and  Lau's  universe  of  dlMCOuraa  is  the  set 
of  all  possible  values  a  variable  can  take  (i.e.  its  domain).  Having 
specified  the  domain,  it  is  generally  a  simple  matter  to  divide  the 
domain  into  subsets  based  on  experience  and  the  current  situation,  for 
exanple,  tamperatura  may  bs  readily  classified  as  Cool,  Sepld,  Warm, 
etc.  and  the  actual  temperatures  corresponding  to  Cool  will  vary 
depending  on  whether  the  system  under  consideration  is  a  fusion  reactor 
core  or  a  liquid  helium  containment  vessel. 

Knowing  the  universe  of  discourse,  a  mapping  from  analog  variable 
values  to  sat  membership  values  is  needed.  The  exact  shape  of  the 
ataubership  function  is  unimportant;  any  arbitrary  choice  is  acceptable, 
although  simplicity  usually  drives  the  choice.  Figure  6  shows  two 
commonly  used  shapes t  trapesoidal  and  triangular.  Although  a 
trapexoidal  shape  is  slightly  more  complicated,  it  captures  the  fact 
that  a  variable,  over  a  restricted  range,  is  often  fully  in  one  set  and 
not  in  any  others. 
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L«t  u^{x)  rsprassnt  th*  da^ra*  that  alamant  ”x"  balonga  to  aat  A 
(tha  sat  menbairship  function).  Than  continuing  tha  braha  axainpla  from 
abova*  a  taoqparatura  of  100  may  balong  to  tha  sata  Cool,  Sapid,  and  Warm 
with 

«Cool<^00>  “ 

u^(lOO)  -  .1. 

Shis  stap  of  assigning  sat  mambarshlp  Is  /ussificaCion.  Nota  tha 
ovarlap  of  tha  thraa  sats.  This  Is  a  )cay  faatura  of  fussy  logic  and 
shows  whara  tha  paraiiai  procassing  paradigm  arlsas,  slnca  a  Tariabla  is 
of tan  a  mambar  of  multlpla  sats.  Also,  using  dascrlptlva  namas  for  sats 
instaad  of  nastad  conditional  statemants  (a  sarias  of  "if  ...  than" 
constructs)  allows  a  mora  intuit Iva  undarstandlng  of  tha  decision  logic 
being  derived. 

Tha  mapping  from  analog  variable  value  to  sot  msmbarship  could  be 
accomplished  directly.  However,  to  make  tha  mapping  to  sat  siambarshlp 
level  generic,  each  variable  la  first  mapped  into  the  same  interval, 
a.g.,  [*■5,5],  and  linguistic  sats  are  than  defined.  Linguistic  sats  are 
Bwraly  stijidard  name  raplacamants  for  variable  ^pacific  sot  names  such 
as  Cool  or  abort.  A  ganarallsad  /ossification  of  any  variable  can  be 
made  with  tha  linguistic  sots  Large  Posltlvo  (LP),  Small  Positive  (SP), 
Saro  (ZR),  Small  Negative  (SN),  and  Large  Negative  (LN)  (sea  figure  7). 
■ot,  fox  axan^le,  might  correspond  to  tha  linguistic  sot  LP.  This 
classification  can  be  expanded  further  with  additional  sats  such  as 
Medium  Positive  or  Vary  Negative,  or  reduced  by  eliminating,  for 
axau^la,  all  Negative  sats  (lit 65).  This  scaled  value  is  than  used  in  a 
lock-up  tabla  for  each  linguistic  sat  (sea  Table  3). 

Cox  provides  sccm  rules  of  thumb  for  defining  linguistic  satst 

1.  She  number  of  sats  should  generally  be  an  odd  number  between  five 
and  nine. 

2.  laeh  sat  should  overlap  with  its  neighbors,  since  this  overlap  is 
idiat  gives  a  fuxxy  controller  its  smooth  and  stable  surface. 


Set 

Membership 

UvM 


Scaled  Analog  Value 


rigor*  7  rurziflcation  of  *n  Analog  Valu*  into  riv*  runy  Sata 
Sabi*  3  Maobarshlp  Matrix  Tabl* 


Linguistic 

Sets 

Quantised  Levels 

••5 

-4 

-3 

-2 

-1 

0 

1 

2 

3 

4 

5 

LP 

0 

0 

0 

0 

0 

0 

0 

.  0 

.5 

1 

1 

SP 

0 

0 

0 

0 

0 

0 

.5 

1 

.5 

0 

0 

Sit 

0 

0 
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0 
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LN 
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1 

.5 
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0 

0 

0 

0 

0 

0 

0 
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3.  Th*  ovorlap  should  b*  10  to  50  p*rc*nt  of  th*  neighboring  space,  but 
th*  sutt  of  tbs  msnbership  values  at  any  point  must  not  exceed  one. 

4.  The  density  of  the  linguistic  sets  should  be  hirnest  near  the 
b^inal  point.  (5t61). 

2. €.3  FuM*y  Logic,  Once  linguistic  sets  are  decided  on  for  all 
input  and  output  variables,  a  full  set  of  logic  rules  is  needed  to 
relate  th*  system  inputs  to  the  outputs.  The  rules  are  devised  using 
the  linguistic  sets  and  the  three  operators  AMD,  OA,  and  MOT.  While  a 
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larg*  number  of  rules  may  be  required,  the  rules  will  be  far  sinipler  and 
fewer  in  number  than  in  the  corresponding  non-fusxy  formulation. 

Fussy  set  logic  is  based  on  the  following  definitions  of  the  basic 
logic  operations i 

1.  The  union  of  set  A  and  set  B  (logical  OR)  is 

o{A  OR  B)  -  mar{u^(x),Ug(x)] 

2.  The  intersection  of  set  A  and  set  B  (logical  ARC)  is 

«(A  AND  B)  ■  min(u^(x),U||(x)) 

3.  The  coa^lcment  of  set  A  (logical  NOT)  is 

o(NOT  A)  -  1  -  u^(x) 

2.6.4  Fussy  Control.  With  the  linguistic  sets  defined  for  the 
input  and  output  variables  of  a  given  system,  and  with  the  necessary 
logic  rules  formulated  to  define  specific  input-'output  relationships, 
fussy  logic  next  derives  the  cvwri.ll  systau  output  by  combining  the 
output  of  each  rule.  As  an  example,  suppose  the  following  three  logic 
rules  aure  in  effect! 

1.  Zf  input  1  is  ZR  AND  Input  2  is  LN,  then  Output  is  8F, 

2.  Xf  Input  1  is  8P  AND  Input  2  is  SN,  then  Output  is  SR, 

3.  IS  Input  1  is  LN  AND  Input  2  is  SN,  then  Output  is  SN. 

Suppose  also  that  the  current  scaled  value  of  Input  1  is  0.8  and  the 
value  of  input  2  is  >2.5.  This  is  shown  in  Figure  8. 

Rule  1  produces  0.7  from  input  1  and  0.2  from  input  2. 
i^lication  of  the  rule's  logical  AND  then  produces  min[0.7,0.2]  >■  0.2, 

1  which  is  used  to  truncste  the  output  SP  trapesoid.  Rule  2  produces  0.3 

i  ■  ■  ' 

1  which  truncates  t!.<v  SR  output  at  the  0.3  level.  Rule  3  produces  0.0, 

I  leading  to  no  ccctributsd  output. 

\  Once  the  ou'puts  for  each  rule  are  determined,  they  aust  be 

eombiaed  into  a  single  output  value.  The  combination  of  individual 
outputs  is  commonly  made  from  one  of  two  basic  methods!  the  coogposite 
maxisMia  or  the  coe^sita  moment  (or  centroid) .  The  choice  of  idtich 
■athod  to  use  is  sosMWdtat  arbitrary,  but  is  often  based  on  simplicity  of 
iagplsmentat  ion . 


Th«  oomposlt*  maxlfflum  Lm  th«  ■laplast  Mthod,  and  conalata  of 
aiaq[>\y  choosing  that  output  having  tha  maximum  value.  Because  this 
ignores  the  results  of  all  other  tiring  logic  rules,  a  significant 
amount  of  information  can  be  lost  and  the  value  of  the  fussy  approach  is 
reduced.  As  rigure  9  shows,  the  centroid  method  provides  an  output 
value  of  0.0,  which  is  just  the  midpoint  of  the  maximum  output  (ZR  from 
Rule  2)  and  ignores  the  output  of  Rule  1  (SP),  which  is  nearly  as  large 
as  the  chosen  output. 

The  composite  swoent  oiethod  is  scsiewhat  mors  complicated,  but  its 
advantage  lies  in  the  fact  that  each  firing  rule  contributes  to  the 
output.  The  various  outputs  at  each  point  are  combined  by  a  logical  OR 
operation.  This  has  the  effect  of  taxing  the  maximum  value  of  all 
outputs.  The  centroid  of  the  combined  output  is  then  the  final  value  of 
the  output.  Zn  essence,  each  output  is  weighted  by  the  value  of  its 
respective  rule.  As  shown  in  Pigure  9,  the  centroid  method  provides  an 
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Output  Valu* 


output  valua  ot  0.8. 

Tho  eantrold  mathod  la  oftan  prafarrad  tacauaa  it  utias  all  tha 
aaailabla  information*  producing  a  "result  that  ia  aanaitiva  to  all  tha 
rules*  ...  hence  the  results  tend  to  move  smoothly  across  the  control 
surface"  (5t61).  The  result  of  either  the  composite  maximun  or  the 
eofl^site  moment  method  is  a  (scaled)  value  of  the  output.  This  must 
then  be  converted  to  an  absolute  (analog)  value  by  the  appropriate 
transformation. 

miile  the  fussy  logic  procedures  can  be  implemented  directly  and 
cosQMted  each  time  they  are  needed*  Li  and  Lau  (lit 67)  recommend  using  a 
look-^up  table  for  speed  and  simplicity.  The  table  is  entered  with  the 
scaled  ii^ut  values  and  provides  the  corresponding  scaled  value  of  the 
output  variable  (see  Table  4). 

As  an  exaaqple*  suppose  brake  ten^erature  and  speed  are  the  inputs 
aad  brake  pressure  is  the  output.  Given  a  tao^erature  of  355  *C  and  a 
speed  of  247  lUPM*  these  variables  scale*  for  exaa^le*  to  1.3  and  3.7* 
rmspaotively.  entering  Table  4  with  these  values  for  inputs  1  and  2 
results  in  an  output  value  of  -3.7  (scaled)*  which  is  thm  transformed 
to  its  final  value  (e.g.  7.9  psi). 
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Xabl*  4  Saopl*  Look-Up  Tabl*  (Lit 68) 


8  1  0  -1  -2  -2  -2  -3  -4  -5  -5  I  -5 


Fussy  eontrollsrs  hav«  s  problso  as  tha  currant  stata  of  tha 

] 

ayataa  approachaa  tha  dasirad  stata  and  tha  control  approachaa  'saro. 

Tha  fussy  controllar  say  than  not  provida  optinal  control,  but  instaad 
caault  in  ovarshoots  and  oscillations  about  tha  dasirad  position  dua  to 
oraroontrol.  Tha  solution  to  this  problaia  is  to  hava  two  diffajrant 

i 

fussy  logic  dacision  tablas,  ona  for  ccarsa  control  and  anothax!  for  fins 
oontrol  (lli€8).  | 

2.i,5  Jtaauits  of  Fussy  Controll»r».  Li  and  Lau  coopara  fussy 
control  algorithms  to  ttro  othar  typaa  of  algorithas  for  a  aarvooiotor 
ayataa  controlling  tha  Tolocity  and  angular  position  of  its  shaft.  Tha 
oonvantional  oontrol lars  ara  a  proport ional-intagral  (PX)  controllar  and 
a  Modal  Mafaranoa  Adaptiva  Control  <MHAC)  controllar.  Tha  fussy  aystam 
uaad  eoarsa  and  fina  controllarsi  it  aay  soaatiaas  ba  naoassary  to  add  a 
third  dacision  table  to  dynasdoally  change  tha  gain  to  prarant 
instability  pr<d>laas  (lli7C'). 

Tha  fussy  eontrollar  outparforaad  tha  PX  controller  and  is  as  good 
as  tha  NRAC  controller,  xt  has  ona-half  tha  settling  tisw  of  tha  KRAC 
and  two-fifths  that  of  the  PX  controllar.  Li  and  Lau  caution  not  to 
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•xp*ct  an  optlioal  raapons*  axcapt  for  cartain  rangas  of  tha  inputs  dua 
to  tha  tuning  and  scaling  that  was  dona  to  tha  controllar.  Bxpanding 
tha  oparating  ragion  naans  adjusting  tha  paramatars. 

Importantly,  fussy  thaory  is  not  yst  matura  anough  to  providafirm 
guidanca  in  how  to  shapa  cr  by  how  much  to  overlap  tha  vaurious 
mambarship  functions.  Too  much  ovarlap  will  rasult  in  too  many  rulas 
simultanaously  baing  appliad,  whila  too  littla  ovarlap  will  maka  tha 
darivation  of  tha  look-up  tabla  difficult  (llt71). 

Chiu  at  al.  raport  on  tha  usa  of  fussy  control  logic  for 
controlling  tha  roll  rata  and  load  allaviation  control  of  tha  Advancad 
Tachnology  wing  (ATW).  Tha  systam  anforcad  torsion  momant  bounds 
without  any  significant  degradation  in  roll  rata  parformanca.  Thay  than 
varied  tha  plant  paranatars  by  50%  to  reduce  stability,  resulting  in 
small  overshoots  in  roll  rata  and  slightly  incraasad  torsion  mocoent 
oscillations.  "Navarthelass,  tha  control  systam  still  maintained  good, 
stable  roll  response  and  stringent  anforcamant  of  tha  torsion  moment 
bounds"  (3t47). 

Thay  further  observe  that  tha  single  sat  of  rules  derived  from 
qualitative  considerations  provided  a  highly  robust  control  system. 

Ooma  of  tha  bounds  are  readily  derived  from  physical  constraints,  tdiila 
others  are  initially  estimated  and  than  adjusted  in  an  iterative  process 
to  arrive  at  tha  desired  response  (3>47). 

Their  final  statement  is  an  axcellant  reminder  of  the  potential 
dangers  of  fussy  logic  i  "tha  greatest  drav^ck  of  fussy  control  is  tha 
lack  of  rigorous  stability  and  robustness  analysis  technique: i.  ...  Tha 
nonlinear  nature  of  fussy  control  affords  enhanced  parformanca 'at  the 
aiipansa  of  analytic  tractabJ  lity"  (3i47). 

2,7  Conclumloa 

Thera  are  several  very  valid  methods  that  can  be  applied  to  the 
CMKCA  tracking  problam.  Dynamic  programming  can,  in  theory,  solve  any 
control  problem,  but  tha  implementation  is  flawed  by  tha  tremendous 
aswunt  of  coaster  memory  required  for  any  but  tha  siiqplast  problam. 


Th«  panalty  function  Mthod  of  Oarton  and  Bachman  achlavad  good  raaults, 
but  usad  vaat  amounts  of  computer  CPU  tlms  and  did  not  provide  any  means 
for  implementing  them  on  aircraft  autopilots. 

Differential  game  theory,  especially  with  the  introduction  of  a 
tfoapons  envelope  similar  to  the  CMMCA's  radar  cone,  seems  to  provide  an 
alternative.  Onlike  differential  game  theory,  where  the  evader  is 
actively  attempting  to  defeat  the  pursuer,  the  CM  is  not  evading.  Hence 
the  extra  complexity  is  not  needed,  but  removing  it  reduces  the  problem 
essentially  to  an  optimal  control  problem.  Optimal  control  offers  easy 
ia^>lementation,  quick  results,  and  the  ability  to  provide  actual  control 
information  to  the  CMMCk. 

Pussy  logic,  used  as  an  adjunct,  would  help  to  implement  whatever 
solution  method  is  chosen  while  taking  into  account  the  experience  and 
knowlr  '.ge  of  the  implementer.  Zt  provides  implsmentation  of  that 
experience  in  a  way  that  remains  intuitive  and  relatively  uncomplicated, 
but  is  still  sophist l.cated  enough  to  capture  the  needed  level  of  detail. 


3.1  Introduction 


•  A-—- 


III,  Methodology 


Thia  cbaptar  daacribaa  the  procedures  used  in  this  thesis  to  solve 
the  CMMCA  tracking  problem.  The  solution  came  from  a  linear  quadratic 
(LQ)  optimal  control  approach  implemented  in  a  nearly  real  time  coi^puter 
simulation.  Located  within  the  LQ  framework  are  all  the  performance 
data  for  both  the  CMHCA  and  the  CM,  system  parameters  and  the  actual 
mechanism  for  computing  the  optimal  CMMCh  flight  path.  A  fussy 
controller  evaluates  current  and  future  gecmetry  and  provides  the 
desired  set  point.  A  simulation  was  used  for  debugging,  model 
verification,  and  performance  analysis. 

The  first  section  discusses  background  material  needed  to 
formulate  the  LQ  solution  and  set  up  the  simulation.  This  includes  the 
solution  algorithm  and  associated  implementation  details.  Then,  because 
the  proper  conqiuter  tools  were  critically  important  to  the  development 
of  a  working  simulation,  both  the  computer  hardware  and  software  used  in 
this  thesis  will  be  covered.  Next  is  a  detailed  accounting  of  the 
ii^ts  to  the  cosqputer  software,  ae  well  as  a  description  of  the  origin 
and  value  of  the  specific  numerical  values  used.  Then  the  different 
scenarios  used  in  this  thesis  will  be  detailed.  This  will  be  followed 
by  a  description  of  the  form  and  content  of  the  simulation  output. 
Finally,  the  details  of  the  simulation  itself  will  be  described. 

3,2  Bnekground  and  Setup 

Since  this  thesis  is  concerned  exclusively  with  the  solution  of 
the  CMKCA  tracking  problem,  it  would  certainly  be  possible  to  modal  the 
flight  capabilities  of  the  CMNCA  and  the  CM  precisely.  This  tfould 
Involve  extensive  research  into  various  performance  and  design 
specifications  and  parameters  of  each  vehicle.  Such  an  approach  has 
been  eseheiMid  in  this  thesis,  both  because  it  needlessly  complicates  the 
basic  issue,  and  because  such  exactness  is  neither  required  nor  desired. 
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A  nor«  general  and  leas  exacting  framework  waa  uaed.  Zn  order  to 
concentrate  on  tho  theory  and  problam  aolution,  it  waa  de«Dod  more 
productive  to  minimiae  time  apent  on  gathering  exact  valuea  for  maximxiffl 
roll  ratea,  "g"  capabilitiea,  thruat  and  drag,  etc.  Zn  place  of  exact 
data,  approximate  valuea  were  aelected  ao  that  both  CMMCA  and  CM 
simulated  performance  cloaely  approximated  that  of  the  real  vehiclea. 

3,2.1  StaCea  of  the  System.  One  of  the  basic  issues  for  any  ZiQ 
approach  is  defining  the  states  of  the  system.  Since  both  the  CM  and 
the  CMMCA  are  free  to  move  in  three  dimensions,  each  has  six  degrees  of 
freedom.  For  example,  the  CMMCA  has  a  position  and  angle  of  rotation 
along  or  about  each  of  three  coordinate  axes.  However,  for  this 
problem,  the  number  of  states  can  be  reduced  to  fewer  than  tha  number  of 
degrees  of  freedom,  due  to  the  constraints  imposed  on  the  two  vehicles, 
and  the  amount  of  information  needed  to  carry  out  the  simulation. 

The  CM  can  be  described  using  only  its  position  in  two  dimensions 
as  a  function  of  time.  Then  it  is  a  single  natter  to  calculate 
velocities,  accelerations  and  bank  angles.  This  was  further  simplified 
by  several  assumptions.  The  first  was  that  tha  CM  is  either  in  straight 
and  level  flight,  or  turning  at  a  constant  bank  angle,  and  that  tha  CM 
makes  instantaneous  transitions.  Second,  the  CM  is  flying  at  a  constant 
airspeed  of  400  kts  (675.11  feet/sec).  Third,  the  CM  maintains  a 
constant  altitude  of  1000  feet  above  sea  level.  Finally,  the  CM  follows 
the  preprogrammed  profile  at  all  times. 

The  set  of  states  for  the  CMMCA  cannot  be  as  sio^la.  However, 
because  of  the  dynamics  of  coordinated  aircraft  flight,  the  six  degrees 
of  freedom  are  not  independent.  Zn  particular,  the  aircraft  pitch 
(angle  of  nose  above/below  the  horison)  and  yaw  (heading)  can  be  readily 
computed  from  the  three  velocity  components.  Hence  the  seven  scalar 
values  of  position,  velocity  and  bank  angle  can  cooqpletely  describe  the 
CMMCA. 

3.2.2  Coordinate  Axes.  To  make  these  seven  states  convenient  for 
use  in  cn  ZiQ  formulation,  it  is  necessary  to  add  the  rate  of  change  of 


tb«  bank  angle  (the  bank  angle  rate).  This  S-atate  rector  for  the  CMMCk 
then  consists  of  the  positions  and  velocities  In  an  X,  t,  and  8 
coordinate  system,  the  bank  angle  and  the  bank  angle  rate.  The 
coordinate  system  Is  a  simple  Inertial  Cartesian  system  (oriented  North, 
Bast, and  down)  fixed  to  the  Barth  with  Its  origin  at  the  Initial 
position  of  the  CMKCk  (see  Figure  10). 


Buler  Angles  (f,  6  and  f) 


To  simplify  matters,  the  CM  stats  vector  Is  made  Identical  to  that 
of  the  CMMCA.  Xn  the  cas^  of  the  CM,  however,  the  values  of  bank  angle 
and  bank  angle  rate  Inside  the  state  vector  are  not  needed  or 
ealoulated,  but  sMrely  carried  as  place  holders. 

Two  other  coordinate  systems  are  necessary  for  certain 
oalcttlatlons.  They  are  a  body  centered  Inertial  system  and  a  body  axis 
system.  Although  these  systesw  can  be  defined  for  any  body,  they  are 
only  needed  here  for  the  CMNCA. 

The  body  centered  inertial  system  Is  Maotly  the  same  as  the  fixed 
Inertial  xrx  coordinates,  except  that  the  origin  is  loeated  at  the 


36 


InstantanaouB  position  of  th«  csntsr  of  mass  of  ths  CMMCA.  That  is,  it 
is  an  inartial  XT8  systam  with  axas  piurallal  to  the  fixed  system  and 
with  origin  tremslated  to  the  C34MCA*s  present  position. 

The  body  aria  systam  is  also  shown  in  Figure  10.  The  origin  is 
located  at  the  canter  of  mass  of  the  CMMCA.  The  positive  X-axis  is 
defined  along  the  direction  of  the  fuselage.  The  positive  Y-axis  is 
defined  perpendicular  to  the  Z-axia  and  outward  along  the  right  wing. 

The  positive  l-axis  is  then  defined  as  perpendicular  to  both  the  X  and  Y 
axes,  and  outward  through  the  bottom  of  the  aircraft. 

Acceleration  along  the  X  body  axis  is  the  change  in  the  speed  of 
the  CMMCA  (if  no  sideslip  is  present).  Acceleration  along  the  Y  body 
axis  is  sideslip.  Sideslip  is  generally  avoided,  especially  in  low 
performance  aircraft  such  as  the  caoiCA;  it  is  assumed  sero  in  this 
thesis.  Z  body  axis  acceleration  ie  caused  by  the  lift  of  the  wings  and 
is  the  ”g"  force.  The  upper  ”g*  limit  is  bounded  by  the  structural 
lindts  of  the  CHHCK,  while  the  lower  *g"  limit  is  usually  a  function  of 
oil  and  fuel  starvation  to  the  engines  and  passenger  discomfort. 

Thm  Control  Variables.  Nith  the  states  and  coordinate  axes 
defined,  the  next  item  of  interest  is  to  determine  the  control 
variables.  These  variables  are  the  inputs  to  the  systetBs;  by  varying 
them  the  system  is  driven  to  the  desired  state.  Xn  problems  involving 
aircraft,  the  natural  control  inputs  are  the  movements  of  the  throttles, 
control  stick  or  yoke,  and  rudders. 

These  controls  together  fully  specify  the  motion  of  any 
conventional  fixed  wing  aircraft,  including  the  CMMCA.  (The  rudder 
pedals  can  be  ignored  here,  since  their  effect  is  usually  to  eliminate 
sideslip  and  hence  to  make  all  turns  coordinated.)  The  throttle 
controls  the  acceleration  of  the  aircraft  along  the  body  X-axis.  The 
yoke  controls  two  different  accelerations.  Fore  and  aft  movement 
changes  the  lift  produced  by  the  wings  and  thus  controls  acceleration 
along  the  body  X-axis.  Rotation  of  the  yoke  controls  the  roll  rate  or 
rotation  about  the  body  z-axis. 


Although  th«  «bov«  thrcM  controls  ara  tha  most  natural,  thay  ara 
not  tha  unas  uaad  In  this  thesis.  Instead,  four  accelerations  ara  usadt 
three  along  tha  fixed  inertial  coordinates  axes  and  one  being  tha  rata 
of  change  of  tha  bank  angle.  Ivan  though  the  X,  t  and  X  inertial 
accelerations  ara  not  directly  attributable  to  physical  events  (such  as 
■oving  the  throttles),  they  can  be  tranafonaed  quite  singly  into 
accelerations  corresponding  to  throttle  and  yoke  aoveoants. 

Inertial  accelerations  are  used  mainly  to  siaqply  the  bookkeeping 
and  mathamatical  traotability  of  the  LQ  formulation,  and  to  maintain  the 
intuitiveness  of  the  simulation  from  the  viewpoint  of  an  external 
observer.  Also,  accelerations  are  used  rather  than  actual  physical 
sKrvaments  of  aircraft  control  structures.  This  is  also  done  for 
simplification.  It  is  relatively  straightforward,  but  quite  tedious,  to 

i 

convert  accelerations  to  yoke  and  throttle  movements. 

3.2.4  The  Llnmar  Ouadratic  Approach.  The  eight  states  and  the 
four  controls  for  the  CMMCA  can  be  described  respectively  by 
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The  dynamics  of  both  the  CMMCA  and  tha  CM  (tha  plant)  can  then  be 
expressed  in  one  of  two  control  law  formulations t  discrete  or 
continuous.  This  thesis  uses  the  discrete  state  equatimi 

X(k+1)  -  VX(k)  >  r,.0(k) 

Berm  X(k)  is  the  state  in  the  kth  time  interval,  0(k)  Is  tha  control 
^plied  in  the  kth  interval,  and  and  r,  are  the  time  invariant  state 
transfer  function  and  control  input  matrices,  respectively. 

Because  the  CMMCA  flight  is,  in  reality,  a  continuous  process,  the 
plant  was  first  formulated  in  tha  continuous  form  of  the  state  equation 

i(t)  -  A(t)*X(t)  ♦  B(t)-0(t) 

The  saa^led  matrices  f,  and  r,  are  extracted  from  A(t)  and  B(t). 
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Tha  control  inputa  0(t)  would  alao  actually  ba  applied  in 
continuoua  tlisa,  howavar,  thia  thaaia  uaed  a  diacrata  control  input 
0(k).  It  ahould  ba  noted  that  the  diacrata  tiina  interval  uaed  (a  aanple 
time  of  one  aacond)  waa  amall  compared  to  aircraft  raaponae  tima  and 
thua  cloaaly  approximated  a  continuoua  control  input. 

The  continuoua  time  atata  aquation  iat 
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Tba  paramatar  a  rapreaanta  the  roll  rasponaa  of  the  aircraft.  A  larqa 
value  of  a  meana  any  bank  angle  change  command  rapidly  affecta  the  bank 
angle,  while  a  amall  value  of  a  aiaana  there  will  ba  aoma  delay  before  a 
caaaMnd  to  roll  right  or  left  ia  realised. 

The  coat  of  control,  a,  was  given  in  the  previous  chapter  as 


J  • -j  x»(tt)S(tt)x{tj)  ♦  [x*0(t)x  ♦  u*R(t)u]dt 


over  the  time  interval  (tg,tf).  Weighting  matrices  8(tf)  and  Q  are 
symmetric,  positive  semidefinita;  R(t)  is  symmetric,  positive  definite. 

Initial  values  of  Q,  R  and  8  were  needed  to  proceed  with  the  LQ 
fonaulation.  The  initial  values  chosen  -for  Q  and  R  were 

10  0  0 

,0100 

R  ■ 

0  0  10 

pool. 

In  this  thesis,  a  steady  state  approach  to  the  X<Q  problem  was 
followed.  This  meant  an  infinite  final  time  was  used  to  calculate  the 
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optimal  controls  and  tha  Riocati  aquation  solution.  Witb  an  infinita 
final  tiffls,  tha  diffarantial  Riceati  aquation  bacama  'lUw  algMt>raic 
Riocati  aquation,  and  tha  Riocati  solution  8  and  tha  Kalman  qain  K  *>ara 
constant  matrices.  Tha  steady  state  solution  tends  to  provide 
asyaqptotic  convairganca  to  tha  desired  state. 

3.2.5  Timm  latmzvmlm.  Unlike  a  classical  regulator  problem, 

*diara  tha  desired  state  of  the  system  is  constant  over  time,  the  desired 
CMHCA  state  is  continuously  changing  as  the  CM  maneuvers.  In  ^ act,  the 
desired  CMMCA  state  —  the  sat  point  —  is  a  cooplex  function  of  the 
current  CMMCA  state,  the  current  and  future  CM  states,  and  tha  range  and 
angles  from  the  CMMCA  to  the  CM. 

To  successfully  deal  with  the  myriad  factors  involved,  thriie 
different  time  intervals  were  defined  (the  simulation  itself  use? 
additional  time  intervals  internally).  These  were  the  sample  tins:,  the 
final  time  update  time,  and  tha  look  ahead  time.  Figure  11  illusi' rates 
these  time  intervals.  Sample  time  was  discussed  in  the  previous  act  ion 
and  was  set  to  the  constant  value  of  one  second. 
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Tht»  CMKCIi  flight  path  traa  broken  into  a  large  number  of  email 
eegmente,  the  end  of  which  ware  called  the  final  time  update  time 
(FTOT) .  In  easence,  a  moving  final  time  waa  being  uaed.  The  length  of 
each  FTUT  aegaant  waa  choaen  to  be  tan  aeconda,  although  it  would  be 
poaaible  to  dynamically  calculate  the  rrUT  aegment  lenci^h  baaed  on  CM 
preaent  and  future  maneuvering. 

At  the  atart  of  the  ITDT  interval,  a  eat  point  for  the  CHMCA  traa 
eomputed,  and  the  optimal  eontrola  were  applied  to  drive  the  CMMCA 
towarda  that  point.  During  each  interval,  the  aet  point  waa  conatant. 

At  FTUT,  the  neat  aet  point  waa  calculated,  and  the  CMMCA  wan  then 
driven  to  that  aet  point.  Thia  l*»p-trogging  of  aet  pointn  waa  repeated 
for  the  entire  flight  profile. 

Figure  12  ahowa  thia  in  detail.  The  large  *Z*  ia  the  next  aet 
point  for  that  FTOT  interval.  The  CMMCA  in  driven  towarda  the  aet  point 
for  the  duration  of  the  preaent  FTOT  interval.  However,  becaune  of  roll 
laga  and  finite  accwlerationa,  the  CMMCA  will  only  make  it  to  the 
location  denoted  by  a  ”0.”  From  thia  point,  tbe  next  aet  point  ia 
computed,  and  the  tracking  begina  again.  Thun  tbe  CMMCA  ia  driven 
repeatedly  through  a  large  number  of  auccenaive  tracking  aolutiona. 

To  exploit  the  knowledge  of  the  minaile'a  flight  path,  it  waa 
necaanary  to  uae  the  future  CM  atate.  The  time  interval  into  the  future 
wan  called  tbe  Icck  ahead  time  (t_ahead).  How  far  into  the  future  to 
look  waa  certainly  not  clear  a  priori.  Therefore,  three  different  look 
ahead  timea  were  examinedi  60,  90  and  120  aeconda. 

J.F.6  FuMgy  logic  and  Hat  Fointa.  Aa  mentioned  in  the  previoua 
aection,  the  entire  nimulation  conaiated  of  a  aeriea  of  time  intarvala 
during  «d)ich  the  CMMCA  waa  driven  to  tbe  next  aet  point.  The 
deteradnation  of  the  next  CMMCA  aet  point  ia  far  from  trivial.  Fuxxy 
logic  waa  uaed  to  calculate  where  the  aet  point  ahould  be.  It  took  into 
account  numeroja,  although  by  no  meana  all  poaaible  factorn. 

The  location  of  the  next  aet  point  waa  baaed  on  what  waa  the  beat 
auuMuver  for  the  CMMCA,  i.e.,  the  beat  courae  of  action  given  the  atatea 


rigors  la  Ths  CMMCA  is  Drivsn  in  s  Sariss  of  Succsssirs  Trscklng 
Solutions  from  0ns  Sst  Point  to  ths  9sxt 


of  tbs  CKMCSk  snd  CM  St  ths  prsssnt  tins  snd  in  ths  futura  at  ths  look 
ahssd  tins.  To  do  this,  ths  fussy  logic  eotnbinsd  all  tbs  factors 
oonsidsrsd  icto  a  bank  angls  bstwssn  ths  maxinun  allowabls  Isft  bank  and 
ths  naxinun  sight  bank.  Mhils  ths  sans  logic  with  ths  sans  factors 
could  have  bssn  ussd  to  coopts  a  spssd  changs,  no  spssd  changes  wars 
oonsidsrsd  in  this  thesis. 

Sines  spssd  and  altitude  were  held  constant  during  ths  sinulatioa, 
ths  only  control  left  was  ths  CMMCk  bank  angls.  Hence  ths  fussy  logic 
was  ussd  to  choose  a  bank  angls  for  ths  CMMCk.  Ths  sst  point  would  then 
be  located  along  this  theoretical  flight  path  at  a  distance 
corresponding  to  a  flight  tine  of  PTDT.  rigurs  13  shows  the  locus  of 
sst  points  that  ths  CKMCk  could  rsaoh  <ths  dashsd  line).  'Tbs  largs 
"X’s*  rsprsssnt  ths  OOiCk  position  if  ths  auucianin  bank  angls  of  30 
dsgrsss  is  ussd,  or  if  ths  CMMCh  doss  not  turn.  As  an  axarals,  ths  sst 
point  with  ths  CNMCA  in  12  dsgrsss  of  right  bank  is  also  shown. 

The  bank  eoevutsd  by  ths  fussy  logic  is  not  nscsssariiy  related  to 
ths  bank  angls  generated  by  ths  optimal  control.  The  logic's  bank  angls 
is  just  a  convenient  way  to  dstsmins  ths  sst  point  in  terns  of  idisrs 
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Vigvra  13  The  Iiocue  of  PoselbXe  catMCA  set  Points 


the  CMKCh  is  capahle  of  resobing.  Xt  wss  then  s  simple  natter  to 
transform  this  bank  angle  into  s  point  in  inertial  space. 

These  values  were  idealised  in  the  sense  that  ciurrent  bank  angle 
was  not  considered.  Xn  other  words,  it  was  sssubmkS  the  CHUinA  ifould 
instantaneously  achieve  the  desired  bank  angle.  The  lag  waused  by  the 
roll  rate  led  to  minor  errors  between  actual  and  set  point  states. 
Howevsr,  this  was  counteracted  by  two  factors,  first,  the  next  set 
point  was  reconputed  at  each  rrOT  independent  of  past  calculations,  thus 
freeing  current  errors  from  future  considerations.  Second,  the  lag 
occurred  on  both  ends.  Although  the  CKMCA  took  a  finite  anount  of  time 
rolling  into  bank,  for  exas^le,  at  the  start  of  a  VTOT  interval,  the 
same  lag  occurred  at  the  next  ITOT  interval,  affectively  causing  the 
OMCA  to  correct  for  the  lag  tine. 

The  fussy  logic  for  oos^uting  the  required  bank  angle  is  applied 
in  two  parts.  The  first  part  determines  required  bank  angle  using  the 
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currant  valuaa  of  tba  CMMCA  and  Of  atatos.  Thla  ia  tha  t_nov  bank 
logic.  Xt  ia  baaed  on  tha  radar  gimbal  azimuth  to  the  CM,  tha  range 
fron  the  OCICA  to  the  CM,  tha  angle  between  the  heading  of  the  CMMCk  and 
the  heading  of  tha  CM  (tha  heading  croaaing  angle  or  HCA)  and  the  turn 
direction  of  the  CM  (left  turn,  no  turn,  or  right  turn)  (nee  Figure  14). 


at  Time  t  now 


The  t_now  bank  value  ia  moat  concerned  with  whether  or  not  tha 
range  or  radar  gimbal  azimuth  ia  approaching  a  limit  and  getting  worae. 
If  ao,  the  t_now  logic  daaMnds  a  large  bank  angle  to  correct  the 
condition.  If  no  limita  are  near,  or  are  clone  but  the  CMNCk  in  alroady 
correcting,  than  the  t^now  logic  generally  requirea  little  bank. 

The  aecond  part  of  the  bank  angle  logfu  uaea  the  future  knowledge 
of  the  CM  flight  path.  Thin  ia  the  t_nexe  bank  logic.  The  required 
hank  angle  ia  baaed  on  the  BCk  from  the  CMMCh'a  preaeat  heading  to  the 
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CM'S  /uciir*  tuiading,  and  tha  radar  global  aslnuth  from  tha  CMHCA’s 
praaant  position  to  tba  CM' a  futura  position  (saa  rigura  15). 


at  Tlota  t  naxt 


Tha  t_naxt  loglo  works  significantly  dlffarantly  than  tha  t_now 
logic.  Zt  Is  blasad  towards  allnlnatlng  futura  problams  by  building 
turning  room  aarly.  This  Is  dons  by  tha  t^naxt  logic  ganaratlng  CMHCA 
turns  away  from  tha  CM  in  an  attsmpt  to  craata  an  offsat.  This  is 
dasignad  to  avoid  both  losing  radar  contact  from  dalayad  CMMCh  turns  and 
daoraasing  ranga  dua  to  cutting  off  tba  insida  of  tha  CM' a  turn. 

Tussy  logic  was  than  usad  ons  last  tlma  to  combina  tha  raquirad 
bank  anglas  darivsd  from  tha  prssant  and  futura  calc'ilatad  valuas.  Tha 
fussy  logic  that  oomblnad  tha  t^now  and  t^naxt  rasults  was  assantially  a 
balancing  act.  If  tha  limits  wars  currantly  baing  approachad,  then  tha 
t^now  required  bank  was  tha  net  result.  On  tha  other  hand,  if  tha 
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Units  wars  currsntly  not  close,  then  priority  was  given  to  the  t_next 
results.  Seme  additional  decisions  were  made  to  prevent  the  CKMCh  from 
building  too  much  offset  by  continually  turning  away  from  the  CM. 

An  important  difference  exists  between  this  thesis  and  the  works 
of  Oarton  s'.d  Bachman.  They  specified  a  nominal  range  (either  eight  or 
ten  miles)  and  a  nominal  radar  glmbal  azimuth  (zero  degrees).  Any 
deviation  from  the  nominal  resulted  in  the  CMMCA  applying  control  inputs 
to  correct  back  to  that  position.  Bare,  the  entire  region  from 
approximately  nix  to  fourteen  miles  in  range  (leaving  a  one  mile  buffer) 
is  considered  to  be  completely  acceptable.  It  is  only  as  range  reaches 
its  limit  that  large  controls  are  generated.  Otharwisa,  only  enough 
control  is  demanded  to  ensure  the  range  stays  within  limits.  The 
asiffluth  control  is  eguivalent.  Anywhere  within  roughly  ±55  degrees  is 
acceptable.  Only  as  azimuth  approaches  the  limits  of  ±60  degrees,  are 
large  bank  angles  demanded  to  return  the  CMMCA  to  within  limits 
(Figure  16). 
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J.J  CompvLfr  XmMouroma 

Bardvarm  and  Opmratlng  Syatama.  Two  difforent  platforms 
tisrs  usad  in  ths  davalopoant  of  ths  simulation.  Much  of  ths  initial 
work  was  dona  on  a  Sun  SPARCStation  2  running  SunOS  4.1.  Tha  majority 
of  tha  %K>rk  was  parformad  on  an  IBM  compatibla  parsonal  cooputar  (PC). 
Tha  PC  usad  an  Xntal  60386  procassor  running  at  25  Mhs,  aguippad  with  a 
Btath  ooprocaasor  chip,  sight  magabytas  (MB)  of  MM,  a  65  MB  hard  disk 
and  a  VOA  graphics  card  with  0.5  MB  vidao  mamory.  Tha  PC  was  running 
MS-DOS  5.0  and  Microsoft  Windows  3.1. 

3,3.3  Application  So/twara.  Tha  antira  simulation  davalopoant 
effort  was  dona  in  tha  Matlab  anvironmant.  Matlab  is  a  product  of  The 
MathWorks,  Xnc.  of  South  Hatick,  Massachusatts.  Tha  larga  cooputar 
Tsraion  (a.g.  Sun  Nor)cstations  and  VAX's)  is  Pro-Matlab,  whila  tha  XBM 
PC  rarsion  is  PC-Matlab. 

Matlab  "intagratas  numarical  analysis,  matrix  ccoputation,  signal 
prooassing,  and  graphics...*  and  includas  *. . .prograonabla  macros,  XBBS 
arithmatic,  a  fast  intarpratar,  ard  many  analytic  ccomands  (16>3).”  Xt 
is  drivan  from  tha  ocomand  lina,  making  it  fully  intaraotirs,  yat  it  has 
a  significant  programming  capability  in  a  matrix  oriantad,  high  Isval 
languags. 

Two  of  its  most  important  faaturas  ara  its  axtansibility  with 
N-fi.fcas  and  its  toolboxas.  M-filas  ara  ASCXX  filss  of  Matlab  commands 
that  arc  axacutad  ‘hither  saquantially  in  batch  mods,  or  also  add  naw, 
usar  dafinad  functions  to  Matlab.  Tha  toolboxas  ara  Matlab  suppliod 

function  librarias  in  tha  form  of  N-filas. 

1 

Tha  Matlab  toolbox’  Simulink  is  a  way  to  simulata  dynamic  systems. 

Xt  allows  tha  usar  to  buHd  a  simulation  by  adding  and  connecting  bloc)cs 
In  a  graphical  anrironmaiU.  Siaiulink  cooes  with  dosans  of  predefined 
blocks  and  easily  incorporates  naw  functionality  by  incorporating 
M-filas.  Its  interactive I  nature  allows  for  real  time  debugging,  as  wall 
as  providing  any  desired  output  for  examination  or  additional  debugging. 
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Slmulink  la  coi^pilad  at  run  time,  and  runs  nearly  as  quickly  as  an 
squivalsnt  FORTRAN  program  (17t3-ll). 

A  nunbar  of  M-£llas  were  written  during  the  course  of  this  thesis. 
The  files  in  Appendix  C  were  used  prior  to  a  simulation  run.  The  first 
four  M-files  convert  CM  flight  paths  into  the  format  needed  during  the 
sisnilations .  The  last  five  M-files  are  used  to  set  up  the  global 
constants,  find  the  Kalman  gains  used  to  compute  the  optJjaal  controls, 
and  generally  to  prepare  everything  for  the  simulation.  The  M-files  of 
Appendix  D  ttere  used  during  the  simulation  runs.  They  all  appear  in  the 
overall  block  diagrams  of  Figure  18,  Figure  19,  and  Figure  20  discussed 
later  in  this  chapter. 

The  following  versions  of  Matlab  and  its  toolboxes  were  usedi 

FC-Matlab  Version  3.Sa  (IS) 

Pro-Matlab  Version  3. 45  (16) 

Control  System  Toolbox  Version  3.03  (4) 

Spline  Toolbox  Version  1.02  (18) 

Sifflulink  Version  1.2.1  (17) 

3.4  SimulMtlon  laputm  *nd  PMraa0tmrM 

The  simalation  is  driven  almost  entirely  by  the  ca^  bilities  of 
the  CMMCA  and  by  the  flight  profile  of  the  CM.  The  CMMCA's  parameters 
are  perhaps  the  most  important,  yet  the  hardest  to  quantify  exactly.  As 
previously  discussed,  this  thesis  took  the  approach  that  the  exact 
values  were  not  required,  merely  reasonable  values  providing  performance 
closely  matching  that  of  the  CMMCA. 

On  the  other  hand,  exart  CM  data  was  not  needed  because  the  CM 
performance  was  not  truly  modelled  at  all.  The  CM  capabilities  were 
embedded  within  its  flight  profiles,  which  were  assumed  to  be  objective 
fact.  Based  on  the  CM  position  as  a  function  of  time,  various  values 
such  as  heading  and  acceleration  could  easily  be  calculated. 

3.4.i  CMMCA  Parameters.  As  in  all  design  problems,  there  are  a 
large  number  of  constants  to  be  chosen,  and  it  is  seldom  clear  a  priori 
what  values  to  choose.  A  common  method  is  to  choose  values  based  on 
experience  and  guesswork,  and  then  adjust  the  values  until  the  response 
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cIoMly  Batches  axpactatlona.  Thia  method  was  adopted  to  set  many 
parameter  values  used  throughout  the  simulation.  These  includedt 

1.  the  maximum  roll  acceleration  (^), 

2.  the  roll  coupling  constant  <«),  _ 

3.  the  various  times  used  (sample  time,  look  ahead  time  and  FTOT),  and 

4.  the  value  of  the  cost  functional  coefficients  found  in  the  Q  and  R 
matrices  of  Chapter  2,  equation  3. 

A  number  of  parameters  ware  dealt  with  by  simplifying  assumptions 

as  discussed  at  the  end  of  Chapter  1.  These  included! 

1.  no  sideslip  (CKKCA  in  fully  coordinated  flight  at  all  times) f 

2.  CKKCA  velocity  constant  at  400  kts, 

3.  uniform  radar  performance  throughout  entire  region  of  coverage,  and 

4.  CH  initially  at  the  canter  of  the  CMMCA's  radar  coverage. 

Additionally,  some  parameter  values  were  used  essentially  unchanged  from 
Bachman’s  thesis.  These  parameters  included  the  maximum  bank  angle  and 
the  radar  coverage  limits. 

The  initial  value  of  the  maximum  roll  acceleration  was  estimated 
from  the  roll  performance  of  aircraft  similar  to  the  CMMCA.  Thie  led  to 
a  maximum  value  of  roughly  8  deg/sec*.  Values  for  e,  Q  and  R  were  set 
initially  at  e  •  0.1,  Q  and  R  an  shown  above  in  section  3.2.4  (2). 

With  these  values  set,  a  number  of  trial  simulations  ifere 
performed  that  forced  the  CKKCA  to  make  a  series  of  turns.  Xxamination 
of  the  bank  angle  .'ates  and  accelerations  was  followed  by  a  modification 
of  the  coupling  constant  to  e  >  0.2;  Q  and  R  were  left  unchanged. 

Through  this  trial  and  error  procedure,  the  simulated  turn  performance 
closely  matched  that  of  the  real  aircraft.  These  values  were  then  fixed 
for  the  remainder  of  this  thesis. 

The  several  time  parameters  were  chosen  for  rather  pragmatic 
reasons.  The  sample  time  of  one  second  was  selected  because  it  seemed 
small  enough  to  capture  any  significant  details,  yet  not  so  small  as  to 
vastly  increase  computer  time.  The  shortest  and  longest  flight  profile 
times  trere  442  and  1850  seconds,  hence  a  sanqple  time  of  one  second  was  a 
good  compromise  value. 

The  value  of  FTUT  was  originally  chosen  to  be  approximately  an 
order  of  ugnitude  greater  than  the  sample  time.  Because  the  simulation 
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workad  wall  with  tha  ohosan  valuaa  of  aampla  tima  and  FTOT,  tbara  was 
Bubsaquantly  naver  any  raason  to  changa  thasa  valuas. 

Look  ahaad  tixoa,  howavar,  is  subject  to  much  gcaatar  variability. 
Tha  valuas  that  wars  finally  chosan  for  considaration  wara:  60,  90  and 
120  saoonds;  simulations  using  all  thraa  tinas  wara  run.  Look  ahaad 
tima  is  discussed  in  mora  datail  in  Chaptars  4,  5,  and  6. 

3,4.2  CM  ^araoatars.  Tha  only  cat  data  known  at  tha  outsat  is  tha 
initial  position  and  ground  track.  Tha  rough  position  data  is  convartad 
first  by  dacomposing  it  into  a  sarias  of  circular  and  straight  sagmants. 
Bacausa  tha  position  data  is  sparse,  thasa  sagmants  would,  in  a  sense, 
ba  ZMSt  fit  curves.  For  this  thesis  effort,  tha  CM  data  was  taken  as  if 
raw  data  had  already  bean  fitted  to  a  sarias  of  circular  and  straight 
sagmants. 

Tha  position  of  tha  CM  was  computed  at  intervals  of  one  second 
<tha  sao^la  time)  along  each  sagmant  for  tha  entire  tima  of  flight.  Tha 
position  data  was  used  to  generate  a  matrix  of  CM  headings,  positions 
and  directions  of  turn  at  intervals  corresponding  to  FTOT  (every  tan 
saoonds)  for  tha  entire  tima  of  flight.  This  matrix  was  used  by  the 
fussy  logic  to  eoiqputa  tha  next  sat  point.  Although  this  could  have 
bean  dona  at  each  set  point  calculation,  pro-coo^ting  this  matrix  sped 
up  tha  simulation. 

Tha  position  data  was  also  run  through  a  spline  generating 
Natlab  M-fila  and  differentiated  twice  to  produce  tha  (inertial) 
accelerations  of  the  CM.  The  purpose  of  generating  splines  was  bacausa 
of  tha  sparsaness  of  tha  actual  CM  position  data.  Zt  is  oxtramaly 
single  to  interpolate  along  a  spline;  also  tha  derivatives  thereby 
produced  will  ba  such  smoother  than  from  tha  raw  data. 

Circular  sagmants  wsra  characterised  by  four  parameters,  tha 
inertial  position  and  velocity  at  tha  start  of  tha  turn,  tha  direction 
of  turn  and  tha  numbers  of  degrees  to  turn.  Straight  sagmants  wara 
characterised  by  thraa  parameters,  tha  initial  position,  the  heading, 
and  tha  length  of  tha  sagmant. 
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Tha  tranafoxmatLon  to  circular  and  straight  aagmanta  was 
ainplifiad  by  tha  assumptions  that  tha  CM  was  £lying  at  a  constant 
walocity  and  that,  whan  turning,  it  did  so  at  a  constant  bank  angle.  As 
raportad  by  Bachman,  tha  CM  usad  20  dagreas  of  bank  in  his  profile  four 
(7t35).  This  thesis  examined  Bachman* a  profile  four  using  both  20  and 
30  degrees  of  bank. 

3.5  Scenarios 

All  scenarios  began  with  the  CMMCA  10  nm  in  trail  of  the  CM  and 
displaced  1000  feet  to  the  Ha>st  (left).  Because  this  nominal  range  is  a 
alant  range,  the  CMMCA  has  an  actual  ground  range  of 

-  (-29000-(-1000>)*)  -  (0-1000)*  -  53,915  ft 

With  no  loss  of  generality,  the  CMMCA  in  initially  placed  at  the  origin 
of  the  inertial  coordinate  axis  system  and  the  CM  due  north  at 
coordinates  X  ■  53915,  T  1000.  Bence  both  vehicles  also  have  initial 
headings  of  360  (or  000),  and  initial  X  and  X  velocities  of  1  ■  675.11 
ft/sec  and  i  ■  0.  The  CMMCA's  X  coordinate  is  fixed  at  -29,000,  the 
CM'S  S  coordinate  at  -1,000,  and  both  their  vertical  velocities  are 
i  -  0. 

This  thesis  examined  the  performance  of  the  CMMCA  over  three 
different  scenarios.  They  corresponded  to  Bachman’s  profiles  one, 
three,  and  four  and  are  repeated  in  Figure  17.  To  prevent  confusion 
between  nomenclature,  they  will  be  referred  to  as  profiles  A,  B,  and  C. 

Profile  A  was  essentially  a  quick  response,  tuning  and 
experiaiental  scenario.  The  simulation  and  fussy  logic  were  developed 
and  tested  first  against  this  profile  because  of  its  simplicity  and 
because  of  the  much  smaller  simulation  time  (442  vs  1850  seconds  for 
profile  A  vs  profile  C)i  consequently  any  debugging  involved  far  lass 
output  to  examine.  Since  profile  A  consisted  of  only  one  turn,  it  was 
ideal  for  developing  the  laost  fundamental  portion  of  the  tracking 
solution  —  a  single  turn  by  the  CM. 
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rigur*  17  Th«  Pro£il«a  Daad  in  this  Thasia 


Profile  B  contained  two  large  tuma,  and  waa  thua  a  uaeful  neana 
of  teating  the  ability  of  the  CMKCA  to  tranaition  fron  one  Qt  maneuver 
to  the  next.  Thia  profile  waa  uaad  to  further  tune  the  fuaay  logic  to 
enaure  it  could  poaition  the  CMMCA  properly  between  maneuvera. 

Profile  C  waa  important  for  two  reaaona.  Xt  repreaanted  a 
challenging  real  world  CM  profile,  hlao,  it  ie  important  to  teat  the 
reaulta  of  the  aimulation  development  on  a  profile  that  had  not  been 
uaed  to  oonatruct  the  aimulation.  Xn  eaaenoe,  profile  C  provided  an 
independent  verification  of  the  reaulta  of  the  CMMCA  tracking  aolution. 
Beeauae  the  value  of  look  ahead  time  waa  not  fixed,  runa  that  looked 
promiaing  were  performed  at  all  valuca  of  look  ahead  time  (60,  90  and 
120  aeeonda). 

J.6  SimulMtiea  Outputa 

Simulink 'allowa  output  of  any  value  during  or  after  the 
aimulation.  Aa  an  aid  to  debugging,  the  output  included  varioua 
InteraMdiate  fuaxy  logic  oaloulationa,  radar  range  and  radar  gimbal 
anglea,  the  atatea  of  the  CMMCA  and  CM,  the  bank,  pitch  and  heading  of 
the  CMMCA,  the  commanded  and  actual  controla  (roll  acceleration  aud 
inertial  eomponenta  of  the  X,  T  and  8  aocelerationa)  and  the  aimulation 
time.  Alao  output,  aa  required  for  debugging  on  different  oooaaiona, 
wnre  varioua  reaulta  produced  internal  to  the  aeveral  M»filea  aa  they 
ccnputed  aet  pointa,  limited  controla,  converted  body  to  inertial 
ooordinatea,  etc. 
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To  dotozain*  tho  auccoas  of  tba  aiaulatlon,  tha  radar  rang#  and 
gladtal  angina  «Mra  nandnd.  To  providn  plota  of  tha  CMXCA  and  cat#  and  to 
ahow  thalr  ralativa  poaltion,  tha  only  additional  information  naauad  waa 
tha  inartial  poaitiona  of  tha  two  vahiclaa,  which  cama  directly  frcaa 
thair  atata  vactora. 

Tha  form  of  tha  output  from  tha  aimulation  waa  aaay  to  intarprat. 
•imulink  by  default  ganaratad  an  output  value  at  each  aampla  time. 

•inoa  moat  outputa  ware  vactora,  tha  full  output  over  the  aimulation  waa 
a  matrix  with  tha  number  of  rowa  equal  to  run  time  and  tha  niimbar  of 
eolumna  equaling  tha  aiaa  of  tha  output  vector,  for  axampla,  tha 
CNMCA'a  atata  vector  output  waa  a  442  by  8  matrix  for  profile  A,  or 
28,288  bytao  (numbara  uaad  8  bytaa  of  atoraga  each). 

2.7  The  tfiauJaeiofi 

A  block  diagram  of  tha  aimulation  ia  ahown  in  Figure  18.  It  can 
be  broken  into  five  main  aactionat 

1.  tha  CM  atata«npaca, 

2.  tha  CKKCA  atata-apaca, 

3.  tba  eat  point  calculation  including  fuasy  logic, 

4.  tha  controla  to  be  applied,  and 

8.  the  bank  angle  acceleration  limiter. 
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Th«  CM  statA-apac*  calculations  hava  for  thalr  input  th« 
accalacations  from  tha  profila  ground  track  and  ara  discussad  in 
saction  3.4.2.  Thasa  accalarationa  ara  fad  into  tha  atata^spaca 
aquations  and  intagratad  at  aacb  sagq»la  tima. 

Tha  CMKC&  stata-apaca  calculations  ara  similar  to  that  of  tha  di, 
axcapt  that  tha  accalarations  coma  from  tha  othar  blocks  of  tha  systmBf 
rathar  than  (uctarnally  from  tha  ground  track  information.  Tha  valua  of 
tha  stata  variablas  at  aach  sanqpla  tima  ara  also  usad  to  cocqaita  tha 
aular  anglas,  that  is,  tha  haading,  pitch  and  bank  angla.  Tha  haading 
(f )  is  darivad  from  tha  projaction  of  tha  valooity  onto  tha  XT  plana. 
Tha  pitch  (0)  is  simply  tha  angla  darivad  from  tha  valocity  coo^nant 
along  tha  Z  axis.  Tha  bank  angla  comas  diractly  from  tha  stata  vactor. 

Tha  sat  point  calculation  is  shown  in  mora  datail  in  Tigura  19. 

It  takas  tha  CM  and  CMKCA  atatas  and  tha  CMHCk  aular  anglas  as  inputs# 
producing  tha  naxt  sat  point  as  output.  Tha  first  block  raprasants  an 
M-fila  that  computas  tha  radar  ranga  and  radar  gimbal  anglas  from  tha 
CXMCh  to  tha  CM.  If  tha  simulation  tima  has  not  yat  advancad  to  fTOT, 
than  tha  currant  sat  point  is  axtractad  from  msax>ry  and  tha  fussy  logic 
is  skipped. 


rignra  19  Tha  Sat  Point  Cooqputation  8ub~routina 


If  simulation  time  has  raaehad  PTOT,  than  tha  states#  aulas  anglas 
and  radar  values  ara  fad  into  tha  fussy  logic  N>fila.  The  fussy  logic 
has  already  bean  described  Li  saction  3.2.6.  The  output  of  the  fussy 
logic  is  tha  inertial  XTZ  sat  pointi  this  is  augmented  with  tha  currant 
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CMHCA  b«nk  anqlft,  Z,  X  and  t  valocitias  and  baiik  anglw  rata  to  provida 
tha  output  in  atata  spaca  form. 

With  tha  currant  atata  and  aat  point  of  tha  CKMCA  availabla,  tha 
aiaulation  naxt  computaa  tha  eontrola  naadad  to  driva  tha  CMMCA  to  tha 
aat  point.  This  ia  carriad  out  in  tha  blocka  in  tha  uppar  right  comar 
of  rigura  18.  Tha  ralativa  arror  batwaan  tha  praaant  CMHCA  atata  and 
tha  aat  point  ia  cooputad  and  nultipliad  by  tha  control  gain  matrix  X 
darivad  from  tha  aolution  to  tha  Riccati  aquation. 

Thaaa  eontrola  ara  tha  ZXZ  inartial  eontrola.  Thay  ara  combinad 
with  tha  aular  anglaa  to  tranaform  tha  eontrola  to  accalarationa  in  tha 
body  axaa.  Bvary  attampt  ia  mada  to  praaarva  tha  diraction  of  tha 
oconandad  accalaration.  Baeauaa  the  CMXCA  ia  at  a  conatant  apaad,  tha 
body  X-axia  acealaration  ia  aat  to  aaro.  Similarly,  baeauaa  no  aidaalip 
ia  allowad,  tha  body  X-axia  accolaration  ia  aat  to  aaro. 

Banca  tha  only  accalarationa  allowad  ara  along  tha  body  E-axia  and 
tha  bank  angla  acealaration.  Tha  bank  angla  will  ba  daalt  with  balow. 
Sinoa  tha  OOiCh  eurrantly  move  i  at  conatant  altituda,  tha  body  K-axia 
acealaration  muat  juat  balanea  tha  forca  of  gravity.  Zt  tuma  out,  than 
that  tha  conatant  altituda,  constant  airapaad  and  no  aidaalip 
raquiramanta  eonatrain  all  accalarationa  axcapt  that  of  tha  bank  angla. 

Tha  bank  angla  acealaration  ealculatioua  ara  shown  in  full  datail 
in  rigura  20.  Tha  naadad  inputs  ara  tha  unlimitad  X,  X  and  S  inartial 
accalarationa,  tha  aular  anglaa,  tha  currant  bank  angla  and  tha  bank 
angla  rata.  As  dascribad  abova,  tha  Inartial  X,  X,  and  S  accalarationa 
ara  convartad  to  tha  body  axaa  and  than  projactad  onto  tha  XI  body  axis 
plana.  Tha  bank  angla  producing  this  diraction  of  acealaration  is  than 
aasily  found  by  satting  tha  CKUCA's  wings  parpandioular  to  this 
projactad  acealaration. 
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rignra  20  Tha  Bank  Angla  Accalaration  Llmitar  Sub-routina 

This  oonaandad  bank  angle  is  than  limitad  to  tha  CMMCk's  naxioium 
bank  angle.  Tlie  result  oi  Figure  2C  is 

♦  ai— iniii  “  (FllidMd  "  *  IC,(4,4)  “  ^actual  *  *8(4.4) 

which  is  just  tha  Kalman  gain  applied  to  the  baitk  angle  and  bank  angle 
rate.  This  commanded  bank  angle  acceleration  is  then  limited  to  the 
maximum  value  of  eight  deg/sac>. 
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IV.  Controller  Development 


4 . 1  Introduation 

This  thttais  auocaaafully  built  a  ainmlation  uaing  optlntal  control 
thaory  and  fuzzy  logic  to  aolv*  tha  caOiCA  tracking  problam.  Tha 
Binulation  waa  built  and  varifiad  uaing  an  incraoantal  approach.  Tbia 
chaptar  daacribaa  how  tha  aimulation  waa  conatructad,  tha  problama 
diacovarad  and  tha  fixaa  introducad  during  ita  davalopmant. 

4.2  8iml»tlon  Pavaiopaant 

Tha  aimulation  waa  davalopad  in  atagaa.  Tha  firat  ataga  waa  to 
build  a  maana  of  ganarating  cat  flight  patha.  Tha  aacond  8|taga  waa  to 
davalop  an  ideal  optimal  controllar.  Thia  controllar  waa  idaal  in  tha 
aanaa  that  it  drove  an  infinitaly  manauvarabla  COtMCA  to  ona  mila  in 
trail.  Tha  naxt  atap  waa  to  incorporata  tha  actual  limitationa  of  tha 
CKMCA  into  tha  aimulation.  Finally,  tha  ona  mila  trail  position  was 

j 

ebangad  to  tha  actual  radar  anvalopa  of  tha  CiMHCA. 

4,2.1  Thm  CM  night  P*th  Generator.  Thia  haa  bean  partially 
diacuaaad  in  aaction  3.4.2.  The  flight  path  generator  waa  written  aa  a 
general  purpoaa  Matlab  routine  uaing  aavaral  M-filaa.  Thaj  CH  bank 

angle,  and  conaaquantly  ita  turn  radiua,  ia  hard-wired  intb  the  flight 

I 

path  generator.  Currently  it  ia  eat  to  20  dagraaa.  The  wtput  ia 
written  to  a  diak  file  for  permanent  atoraga.  All  of  thaae  computationa 
are  parforaad  oit-lin*  to  apaad  up  the  aimulation. 

Thw  input  ia  a  flat  data  file  conaiating  of  an  n  x  2  array,  laoh 
of  tha  n  rowa  corraaponda  to  either  a  atraight  or  turning  flight  path 
aagmant.  Tha  firat  column  ia  that  aegmant’a  turn  diractiont  -1  for  a 
left  turn,  *1  for  a  right  turn  and  0  for  no  turn.  Tha  aacond  trolumn  ia 
a  duration  •>  the  number  of  dagraaa  to  turn  or  tha  diatanca  (in  feat)  to 
go  atraight. 

After  reading  thia  data  file,  the  generator  takaa  each  aagmant  in 
turn,  creating  an  array  of  pointa  along  that  aagmant  at  ona  aacond 


lutaarvala.  Than  a  spline  is  fitted  to  these  points  and  differentiated 
twice  to  provide  an  array  of  CH  accelerations.  After  all  segments  are 
cooplete,  they  are  combined  into  the  eurray  "U”  shown  as  the  CM 
accelerations  in  the  upper  left  of  Figure  18,  Chapter  3.  This  array  is 
also  used  to  generate  a  second  array  of  CM  headings,  X  and  Y  positions, 
and  direction  of  bank  at  one  second  intervals. 

4,2.2  Tb»  "Idtal"  Optimal  Controllmr,  This  is  implsmented  as 
shown  in  Figure  21,  a  simplified  version  of  the  ultimate  controller  of 
Figure  18.  At  this  stage  of  the  simulation  development,  the  CMMCA  has 
no  limits  on  its  performancet  it  rolls  instantaneously  to  iviy  bank, 
changes  to  any  speed  in  zero  time,  and  is  capable  of  generating  infinite 


accelerations.  The  CMMCA's  position  has  been  set  to  one  nautical  mile 
(ground  range,  not  slant  range)  in  trail  of  the  CM. 


Figure  21  Block  Diagram  of  Simulation  for  Unconstrained  CHMCA 


Maneuvering 

Because  of  the  unlimited  controls,  the  CMMCA,  should  be  able  to 
exactly  track  the  CM.  At  each  time  step,  the  set  point  is  computed  one 
mile  dead  astern  the  CM.  Then  the  optimal  controls  are  applied  to  the 
CMIKA  to  drive  it  there  in  that  one  second  time  interval.  This  moans 
there  is  no  residual  error;  at  each  sample  time  control  calculation,  the 
CMMCA  starts  precisely  from  where  it  is  supposed  to  be. 


This  stag*  of  davalopoant  had  two  major  purpoaaai  1)  to  bacooa 


oomplataly  familiar  with  Simulink  and  all  of  ita  comploxitiea, 
intricaciaa  and  idioByncraciaa;  2)  to  davalop  a  trorking,  albait  vastly 
simplifiad  (and  atill  incomplata)  simulation.  On#  of  tha  many  problsms 
with  this  stags,  of  courss,  is  ths  that  tha  lack  of  limits  laads  to 
CNMCX  accalarations  of  many  hundrads  of  *g's,"  and  spaad  changas  of 
thousands  of  knots.  This  is  daalt  with  at  tha  naxt  stags. 

Tha  raason  for  ona  mils  trail  as  opposad  to  tha  nominal  cantar  of 
radar  covaraga  at  tan  milas  is  for  simplicity.  A  position  tan  milas  in 
trail  would  rasult  in  significant  crack-tha-wAip  problams  as  ths  CM 
turnad.  Tha  intant  was  not  tracking  to  maintain  radar  covaraga,  but 
simply  to  control  tha  CMMCA. 

This  portion  of  tha  simulation  building  want  ralativaly  smoothly. 
Tha  CMMCA  was  abla  to  track  tha  CM  on  any  profila  undar  considaration. 
Achiaving  this  stap  providad  tha  ability  to  fall  back  to  a  working 
simulation  if  problams  tfsra  ancountarad  latar  in  any  of  tha  stagas. 

4.2,3  Tha  Optim*!  Controllmr  with  Limita.  Incorporating  tha 
physical  limitations  of  tha  CMMCA  into  tha  simulation  rasultad  in  a 
simulation  closa  to  that  of  rigura  18,  chaptsr  3.  Bowavar,  tha  sat 
point  is  tha  sama  as  in  ths  prsvious  ssction,  that  is,  ona  milM  trail. 

Zn  this  stap,  tha  CMMCA  is  limitad  in  bank  angla,  roll  rata,  "g* 
capability  and  spaad  changa.  Bancs,  tha  CMMCA  cannot  ganarally  raach 
tha  naxt  sat  point.  Movarthalaaa,  tha  CM  profila  should  allow  tha  CMMCA 
to  track  it  »rall  from  tha  ona  mils  trail  position. 

Tracking  was  not  diractly  a  major  goal  at  this  stags.  Tha  raal 
goal  was  to  proparly  coda  tha  CMMCA  physical  rastrictions  into  tha 
simulation.  Tracking  was  maraly  fsadback  to  varify  tha  rastrictions 
warm  is^laowntad  corractly. 

Tha  first  sarious  difficulty  was  ancountarad  at  this  point.  Tha 
idaa  was  to  oomputa  tha  commandad  CMMCA  inart ial  accalarations,  and  than 
to  limit  this  accalaration  basad  on  tha  CMMCA' s  capabilitias  whila 
maintaining  tha  diraction  of  tha  original,  unlimitad  accalaration.  This 
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lad  to  conceptual  problem*  as  to  exactly  what  that  direction  meant  and 
how  to  properly  limit  the  acceleration. 

A*  mentioned  in  the  previous  chapter,  the  inertial  acceleration 
was  transformed  into  the  body  axis  coordinate  system.  Then  the  X 
component  was  limited  independently,  since  it  represented  a  change  of 
the  CMHCA's  speed.  The  Y  and  Z  components  together  represented  the 
acceleration  of  the  CMMCA  due  to  lift  from  the  wings.  Xt  was  unclear, 
however,  whether  this  also  sho-tld  include  gravity. 

Iventually,  it  became  clear  that  the  YZ  body  acceleration  was  the 
direction  to  maintain  and  did  include  gravity.  Zn  other  words,  the 
CMMCA* s  "g"  acceleration,  sideslip  acceleration  and  the  acceleration  due 
to  gravity  should  add  up  to  an  acceleration  in  the  same  direction  as  the 
commanded  YZ  body  acceleration. 

This  was  often  not  possible,  however.  Suppose  the  CMMCA  was  in 
thirty  degrees  of  left  bank  and  the  commanded  acceleration  was  to  the 
CMMCA* s  right.  No  combination  of  allowable  sideslip  and  **g**  would  allow 
tne  CMMCA  to  go  right  while  in  left  bank.  The  allowable  sideslip  was  in 
the  range  of  1/4  to  1/10  of  a  **g,**  moreover,  the  desire  was  for  no 
sideslip.  Therefore,  the  decision  was  mad*  to  restrict  the  CMMCA  to 
sero  sideslip.  Its  contribution  to  CMMCA  capabilities  was  minuscule,  it 
would  never  actually  be  used  by  the  aircrew,  and  it  vastly  increased  the 
complexity  of  the  control  limiting  algorithm. 

Kith  sideslip  limited  to  zero,  and  speed  controlled  independently, 
the  only  acceleration  left  was  along  the  Z~body  axis.  Maintaining  the 
direction  of  the  commanded  acceleration  was  then  a  simple  matter  of 
finding  the  "g's**  that,  together  with  gravity,  mad*  their  sum  as  close 
yas  possible  to  the  original  commanded  acceleration. 

The  heart  of  the  limiting  process,  then,  was  not  really  the  Z,  Y 
or  Z  accelerations,  but  rather  the  bank  angle  accelerations.  The  CMMCA 
can  really  only  accelerate  in  the  direction  in  which  it*s  banked.  Thus 
it  snist  be  forced  to  bank  in  the  required  direction,  as  determined  by 
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tlM  diraction  of  tha  conmandad  accalaration.  Tha  bank  angla 
aocalaratlon  calculation  was  shown  in  Figura  20,  Cbaptar  3. 

This  calculation  is  raally  just  multiplying  tha  CMKCA  statas  by 
tha  optimal  gains,  «L^racting  only  tha  if  (fourth)  component  of  the 
control,  and  than  limiting  tLa  resulting  CMMCA  bank  angle  accalaration 
command  to  match  tha  CKHCA's  capability.  Tha  -^•K^(4,8)  portion  of  tha 
calculation  (lowar  half  of  tha  figura)  serves  to  dacraasa  tha 
accalaration  to  zero  as  tha  roll  rata  grows.  Tha  upper  half  of  tha 
figura  corresponds  to  decreasing  tha  acceleration  to  saro  as  the  bank 
angla  itself  approaches  maximum. 

This  is  one  iuiportant  area  where  this  thesis  differs  markedly  from 
tha  prior  three.  Bara  tha  bank  angla  is  automatically  )cept  within 
limits;  the  structural  limits  are  navar  exceeded  (there  is  actually  a 
slight  over-bank  of  up  to  one  degree  due  to  aircraft  dynamics).  Thus 
only  tha  radar  limits  can  be  axcaadad  with  this  method. 

To  verify  tha  proper  working  of  tha  limiter  algorithm,  tha  CMMCA 
was  simulated  over  several  flight  paths.  Tha  early  trials  were  with 
short  profiles,  and  as  confidence  increased,  longer  profiles  were  used. 
The  current  algorithm  is  apparently  correct,  since  the  CMMCA  has  the 
ability  to  track  the  one  mile  trail  position  quite  well  over  a  fairly 
convoluted  profile.  It  will  not  track  perfectly  due  to  its  designed 
limitations.  The  cause  cf  most  of  the  error  between  the  CMMCA 's  present 
position  and  the  set  point  is  because  of  the  delay  imposed  for  the  CMMCA 
to  roll  to  the  needed  bank  angle  and  begin  turning. 

4,i»4  The  Xadar  Mnvmlopm  Bet  Point  with  Fussy  Logic.  At  this 
stage,  tha  CMMCA  does  not  yet  accurately  track  the  CM,  since  no  account 
is  made  of  the  information  supplied  by  the  radar  or  the  knowledge  of  the 
CM'S  future  ground  track.  The  controller  needs  to  dynamically  compute 
and  altar  the  sat  point  based  on  the  radar  and  the  CM's  flight  path. 

This  is  the  final  stage  of  simulation  development  wherein  fussy  logic 
was  used  to  determine  sat  points. 


Tha  tranaitlon  from  the  previous  simulations  to  this  last  stage 
involved  a  fundamental  conceptual  shift.  The  prior  work  involved 
determining  sat  points  relative  to  the  CM  —  one  mile  trail  of  the  CM. 

At  this  stage  the  shift  is  towards  making  the  set  point  relative  to  the 
CKMCA  itself.  Section  3.2.6  discussed  set  point  determination  in 
detail;  the  ncuct  section  will  discuss  the  fussy  logic  that  determines 
the  set  point  at  intervals  of  FTOT. 

4.3  D»vlopmant  of  the  FuMMy  Logic 

4.3.1  Introduction.  The  fussy  logic  was  discussed  at  length  in 
sections  3.2.6.  The  nature  of  fussy  logic  requires  that  expert 
knowledge,  opinion  and  intuition  be  a  fundamental  portion  of  the  set 
point  logic.  The  logic  was  used  to  drive  the  CMMCA  to  successive  set 
points,  each  one  chosen  to  maintain  current  radar  coverage  and  to  ensure 
that  radar  coverage  would  be  possible  in  the  future. 

The  prime  merjis  of  ensuring  future  radar  coverage  was  to  recognise 
approaching  problems  and  to  avoid  them  by  having  the  CMMCA  maneuver 
early.  !%ecognising  problems  early  meant  examining  where  the  CM  will  be 
at  the  look  ahead  time  (t^ahead),  as  well  as  what  it's  doing  then. 
Difficulties  arose  any  time  the  CM  went  into  a  long  turn  (exceeding 
roughly  90  degrees).  As  discussed  in  Chapter  1,  when  facing  a  large  CM 
turn,  the  CMMCA  is  hard  pressed  to  maintain  radu  coverage. 

The  solution  appeared  obvious  (from  the  pilot's  perspective);  turn 
the  CMMCA  slightly  away  from  the  CM'e  upcoming  turn  to  build  turning 
room,  turn  back  into  the  CM  to  prevent  it  drifting  out  the  side  of  the 
radar  coverage,  then  turn  back  inside  the  CM's  turn  circle  (nee  the 
plots  in  Appendix  A  for  examples).  The  initial  offset  allows  the  CMMCA 
to  delay  its  eventual  large  turn.  This  delay  prevents  the  CMMCA  from 
drastically  decreasing  the  range,  because  otherwise  it  would  be  forced 
to  turn  much  earlier,  closing  the  distance  significantly. 

Another  important,  yet  related  portion  of  the  logic  occurs  after 
finishing  a  maneuver  and  before  beginning  the  next.  Instead  of  the 
CMMCA  sisqily  returning  to  a  trail  position,  it  is  better  for  It  to 
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diaplac*  off  to  on«  aids.  The  eida  chosen  should  be  the  side  opposite 
the  next  turn  direction,  thus  sutomstically  building  in  turning  room. 

The  fussy  logic  was  impl«nented  in  five  logic  tables.  Three 
tables  computed  the  contribution  to  the  CKMCA's  bank  angle  at  t_now,  one 
table  at  t_next,  and  the  last  table  combined  the  t_now  and  t__next 
values.  Zach  table  was  purposely  designed  to  stand  alone;  that  is,  only 
the  inputs  for  that  table  tMra  taken  into  consideration.  Although  it 
seems  artificial  to  separate  out  and  ignore  other  factors,  the 
alternative  is  actually  to  create  one  extremely  large  and  complex  table 
with  six  or  eight  inputs  and  as  many  logical  operations.  Doing  this 
would  defeat  the  entire  purpose  of  using  fussy  logics  the  intuitiveness 
and  simplicity. 

Purthermore,  the  different  inputs  were  all  considered  by  using 
nested  logic.  For  example,  four  factors  were  used,  two  each  in  two 
different  tables,  to  determine  the  two  inputs  to  the  t__now  bank  value. 
Then  they  were  in  turn  used  as  the  inputs  to  a  third  table  to  compute 
the  t_now  bank  command.  This  fashion  of  modularising  the  fussy  logic 
was  similarly  used  to  combine  the  t__now  and  t_next  values. 

The  fussy  logic  tables  that  follow  in  this  chapter  represent  the 
final  results  at  the  conclusion  of  the  experimental  process.  A 
discussion  of  the  evolution  of  the  table  entries  is  located  in 
section  5.2. 

4.3.2  t_nov  Fuaxjr  Logic.  Although  creating  an  offset  was 

ioqportant  to  prevent  future  CMMCA  tracking  problems,  it  was  equally 
isqportant  to  preclude  loss  of  radar  coverage  in  the  next  few  seconds. 

The  t_now  bank  command  logic  was  crafted  to  avert  imminent  loss  of  radar 
coverage  in  the  extreme  case,  and  to  force  the  CMMCA  to  follow  the  CM 
with  more  moderate  controls  in  other  eases.  This  logic  (Table  6)  was 
synthesised  from  the  outputs  of  two  fussy  logic  tables  (Table  5;. 

Table  Sa  uses  the  current  asimuth  to  the  CM  and  the  beading 
crossing  angle  (HCA).  Table  Sb  uses  the  range  to  the  CM,  the  CM's  turn 
direction  and  the  sign  of  the  radar  gimbal  asimuth  (±1,0).  Both  tables 


ar«  basad  on  the  variablee  dlaplayed  in  Figure  14  and  Figure  15  and 
discueaed  in  aection  3.2.6. 


Sable  5  U>gic  Tablea  for  t_now  Bank  Using  Acimuth  and  BCAr  and  Range 

and  CM  Turn  Direction 


Azimuth 


HCA 


azi  hca 


row  #  g  Range  d^e^fgn 
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LP 


SP 


ZR 


SN 
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SP 

ZR 

SN 

LN 
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I 
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SP 

ZR 

SN 
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LP 

LP 

LP 

SP 

.-.SSL. 

SP 

SP 

SP 

ZR 
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SP 

SP 

ZR 

SN 

SN 


1 

2 

3 

4 
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6 

7 

8 

9 
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SP 
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ZSRO 
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11 

12 

13 

14 
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ZSRO 
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1 

1 

1 

1 

1 

1 

1 

SP 

1 
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SN 
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SN 

ZERO 

1 

1 

SN*D 

fN 

SN 

19 

NBO 

1 

1 

SP 

iN 

1 

SN 
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LP 

LP*D 

LN 


SP 

SP*D 

SR 


ZR 

ZR 

ZR 


LN 


LP  j  SN 

8?  j  i 

POS 

ZR  1  l: 

LN  ZSRO 

SN  {  LN 

24  1 

NBO 

LN  !  LN 

Notai  p.  is  the 

LN 

LN*D 

LP 


The  logic  for  the  azimuth/HCA  table  (Table  5a)  ia  straight¬ 
forward.  Zf  the  CM  is  nearly  at  the  edge  of  the  radar  azimuth  limit  and 
not  correcting  back,  than  the  CMMCA  should  make  a  bard  turn  towards  the 
CM.  Zf  the  CM  is  nearly  off  the  side  of  the  scope,  but  is  correcting 
back,  than  the  CMMCA  need  only  make  an  easy  turn  towards  the  CM.  Zf  the 
CM  is  off  to  the  side  but  not  close  to  the  edge  of  the  radar  enrelope. 
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than  th«  CMMCA  should  •■■•ntially  make  an  aaay  turn  in  the  direction 
that  the  CM  is  heading. 

For  example,  if  the  CM  ie  to  the  right  and  going  further  right 
(lines  6  &  7  of  Table  5a),  then  the  CMMCA  should  make  an  easy  right  turn 
to  hold  the  CM  at  the  same  azimuth.  If  instead  the  CM  had  been  moving 
back  to  the  left  (lines  9  or  10),  then  the  CMMCA  should  maintain  heading 
or  make  an  easy  left  turn,  if  the  CM  in  at  small  azimuths  (lines  Il¬ 
ls  ),  then  the  CMMCA  should  make  an  easy  turn  in  the  direction  of  the 
CM'S  heading. 

Table  5b  implements  the  fuzzy  logic  to  control  the  CMMCA 'n  turn 
using  the  radar  range  to  the  CM,  the  CM's  turn  direction,  and  the 
azimuth  to  the  CM.  The  decision  logic  is  simple t  if  the  CMMCA  is  too 
far  behind  the  CM,  it  needs  to  decrease  the  range  by  cutting  across  the 
CM's  turning  circle.  If  the  range  is  too  small,  the  CMMCA  needs  to  turn 
away  from  the  CM  to  increase  the  range.  When  the  CM  is  turning,  the 
direv-vion  for  the  CMMCA  to  turn  is  either  in  the  same  or  opposite 
direction  as  the  CM.  Bcwever,  when  the  CM  is  not  turning,  then  the  sign 
of  the  azimuth  to  the  CM  is  used  to  determine  which  direction  is  away 
from  the  CM  (the  factor  of  "0”  in  the  table) . 

Table  6  consists  of  the  logic  used  to  integrate  the  two  bank  angle 
values  (scaled)  computed  by  Table  5.  This  integration  is  based  on 
passing  through  unchanged  any  large  bank  angle  command  (LN  or  LP)  from 
either  component.  This  is  biased  slightly  in  favor  of  the  azimuth/HCA 
eos^nents  versus  the  r.mge  component.  When  neither  coo^nent  is  large, 
the  output  of  the  corresponding  rule  is,  in  some  sense,  the  average  of 
the  two  ocoqponents. 

4.3.3  The  t^.next  Fuggy  Logic.  The  fuzzy  logic  to  determine  the 
CMMCA  turn  at  the  look  ahead  time  is  more  complicated.  It  is  based  on 
building  turning  room  early  by  having  the  CMMCA  turn  away  from  the  CM 
(see  Table  7).  None  of  the  outputs  from  this  table  are  large.  This  is 
to  ensure  that  while  a  slight  turn  away  from  the  CM  can  occur,  largo 
turns  will  not  happen,  and  that  large  t_now  values  will  swamp  t_next 
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Sabi*  6  Logic  Tabla  for  t_now  Bank  Coicbining  Results  frost 
AEimuth/HCA  and  Itonge/CIl  Turn  Direction 


ua 


IF  «*y>ca  ^  then  nos^bank 


LP 

any  value 

LP 

LP 

LP 

SP 

SP 

SP 

ZR 

SP 

SN 

ZR 

LN 

SN 

LP 

LP 

SP 

SP 

ZR 

ZR 

ZR 

SN 

SN 

LN 

LN 

LP 

SP 

SP 

ZR 

SN 

ZR 

SN 

SN 

SN 

_  LN _ 

LN 

LN _ any  value _ 


values  when  those  results  are  combined.  Also,  it  solved  an  early 
problem  wherein  the  CHMCA  continually  turned  away  from  the  CM,  never 
turning  back  towards  it. 

4.3.4  TA*  Met  Bank  Tuxzy  Logic.  At  this  point,  there  is  one  bank 
command  value  usually  forcing  the  CMMCA  to  turn  towards  the  CM  in  order 
to  track  it  (the  t_now  value),  and  another  forcing  the  CMMCA  to  offset 
by  turning  away  froa  the  CM.  Baleuicing  the  near  term  and  future 
requirements  was  therefore  a  critical  task.  The  means  of  acconqplishing 
this  often  contradictory  task  were  discussed  in  section  3.2.6  in  general 
terms.  The  final  form  of  the  logic  is  shown  in  Table  8. 

The  first  and  last  row  of  the  table  correspond  to  the  situation 
where  the  CMMCA  must  turn  immediately  or  loss  radar  contact.  The  output 
for  all  such  cases  is  made  independent  of  any  t_next  consideration,  and 
is  a  hard  turn  towards  the  CM  to  preserve  radar  coverage. 
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Xabl«  7  Logic  Tabl*  for  t_naxt  Bank  Uaing  ksianith  and  BCA  at  tha 

Look  khaad  Tiiae 


naxt  axi  naxt  HCA  naxt  bank 

ia  ^  li  il 
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SR 
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SP 
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SN 
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SR 

SN 

SR 
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SP 
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LN 

SP 

LN 

LN 

SR 

SN 

SN 

SP 

LN 

LP 

All  rowa  othar  than  tha  firat  or  laat  corraapond  to  t_now  codnanda 
for  a  amall  or  aaro  turn;  tha  CNMCA  only  naada  a  mall  bank  to  track  tha 
CM  and  tha  naad  to  turn  ia  not  urgant.  Bara  la  whara  tha  balancing  of 
praaant  and  futura  cocamanda  occura.  Tha  majority  of  waight  ia  givan  to 
tha  t_naxt  input,  ainca  tha  CKKCA  ia  not  in  any  Innadiata  dangar  of 
loaing  radar  covaraga.  Magativa  t_now  valuaa  (laft  turna)  raault  in  an 
output  aqual  in  aiaa  but  oppoaita  in  diraction  aa  for  tha  poaitiva  caaa. 

4.3,5  The  FuMMy  Set  Membmrmhip  Fuactionm.  Ifhila  tha  daciaiona 
iaqplaeMntad  in  tha  fuzzy  logic  obvio*ialy  drova  tha  coomandad  bank  for 
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Xabl*  8  Iiogic  Table  Combining  t  now  and  t  next  Puzzv  I<ogic  Inputs 


the  CKMCA,  it  turned  out  that  the  membership  functions  were  also 
important.  The  first  half  of  choosing  a  membership  function  was  to 
determine  how  the  raw,  analog  ▼aluss  should  map  into  the  scaled  range 
[-5,5].  The  second  half  of  the  membership  function  was  the  shape  of  the 
function  itself.  The  shape  and  spacing  of  the  membership  functions 
suggested  in  the  literature  was  sho*  i  in  Figure  7,  Chapter  2. 

The  mapping  applied  to  five  of  the  factors  used  in  the  fussy  logic 
tables.  They  are  summarized,  along  with  their  possible  and  usual 

I 

ranges,  in  the  first  three  columns  of  Table  9.  IXt  seemed  reasonable  to 
map  the  usual  ranges  shown  in  column  three  of  Table  9  to  the  range 
[•>5,5].  However,  the  performance  of  the  CKMCA  needed  to  improve  at  two 
places t  as  the  CM  approached  approximately  30  to  «5  degrees  of  azimuth 
at  t_now,  and  during  the  time  the  CM  was  flying  straight  and  level 
following  a  largo  turn.  I 

The  first  performance  problem  was  because  the  CKMCA  offset  away 
from  the  CM  for  turning  room  and  consequently  the  current  azimuth 


Vabla  9  The  Fuzzy  Logic  Factors  and  Their  Ranges 


Factor 

Possible 

Range 

Dsual 
Ran^e _ ^ 

Mapped 

Range 

t  now  azimuth  (degrees) 

[-180,1801 

[-60,60] 

[-60,60] 

t  now  RCA  (degrees) 

[-180,180] 

[-180,180] 

[-135,135] 

t  now  range  (nm) 

[0, infinity] 

[5,15] 

[5,15] 

t  next  azimuth  (degrees) 

[-180,180] 

[-180,180] 

[-6p,6.qi_  I 

t  next  HCA  (degrees) 

[-180,180] 

[-180,180] 

[-180,180]  1 

approached  the  limit.  The  net  bank  logic  gave  too  much  weight  to  the 
t_next  input  tmd  continued  to  offset  the  CMMCA  until  too  late.  At  that 
point  the  CMMCA  could  not  turn  fast  enough  to  keep  from  losing  radar 
contact  with  the  CM. 

The  second  problem  was  at  the  end  of  the  CM*s  maneuvering.  The 
CMMCA  would  finish  its  turn  and  end  with  an  HCA  of  approximately  25-35 
degrees.  Then  it  wou2d  continue  to  diverge  from  the  CM’s  heading  until 
the  azimuth  limits  wwre  approaching.  This  divergence  also  meant  that 
the  CMMCA  was  not  driving  towards  a  position  from  where  it  would  be 
properly  set  up  for  the  next  maneuver. 

The  solution  to  both  of  these  problems  was  accomplished  by 
changing  both  the  mappings  to  the  scaled  range  and  by  re-defining  the 
fussy  set  membership  fiinctions.  The  new  mappings  amounted  to  changing 
two  factors  from  their  usual  ranges,  the  t_now  BCA  and  t_next  azimuth. 
Reducing  the  mapped  range  of  t^now  BCA  reflected  the  need  to  react  more 
to  current  HCA  than  was  being  done,  while  reducing  the  t_next  azimuth 
range  kept  the  CMMCA  from  turning  too  far  during  its  offset  maneuver. 

instead  of  changing  the  mappings  and  the  set  membership  functions, 
the  same  results  could  have  probably  been  accomplished  by  modifying  the 
fussy  logic  rules.  However,  the  former  changes  seemed  the  most 
expedient  and  straight  forward,  while  retaining  the  intuitive  nature  of 
the  fussy  logic,  changing  the  logic  rules  would  have  required  losing 
those  advantages  to  force  the  same  outcome. 
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tb«  fuzzy  logic.  Changing  tha  logic  rules  would  have  required  losing 
those  advantages  to  force  the  same  outcome. 

The  final  factor  ranges  are  shown  in  tha  last  column  of  Table  9. 
Any  values  that  exceed  these  ranges  (such  as  a  t__next  azimuth  of  80 
degrees)  are  simply  truncated  to  tS  during  the  mapping.  The  final  fuzzy 
set  awnbership  functions  are  shown  in  Figure  22.  The  major  change  is  a 
large  expansion  in  the  size  of  the  set  "ZR."  This  has  a  two-fold 
effect:  t_now  maneuvering  is  only  performed  as  necessary,  and  the  CMMCA 
terminates  its  offset  steering  after  only  a  small  turn  away  from  the  CM. 


Figure  22  The  Fuzzy  det  Membership  Functions  in  Their  Final  Form 


V.  ResultB 


5.1  Introduction 

This  chaptar  praaants  tha  rasulta  obtainad  from  fouirtaan 
aiduiXation  runs.  Tha  first  saction  staps  through  tha  runs,  with  a 
discussion  ot  what  was  ▼ariad  to  improva  tha  siarjlation.  Tha  last 
saction  contains  inforaation  on  tha  aionilation  run  times,  and  aoma  ways 
to  in^rova  them. 

5.2  Kasuits 

Tha  rasulta  for  simulation  runs  during  tha  tasting  and  tuning  of 
tha  fuzzy  logic  (as  discussed  previously)  can  ba  seen  in  Tabla  10.  Tha 
results  in  Tabla  10  are  listed  in  tha  chronological  order  that  tha 
simulations  were  run,  which  represents  an  evolution  of  tha  sat  point 
fuzzy  logic.  Within  aach  row  of  Tabla  10,  cnly  tha  look  ahead  time  was 
changed,  while  from  one  row  to  tha  next,  either  tha  fuzzy  logic  rules  or 
tha  sat  membership  functions  ware  changed.  Appendix  A  contains  plots  of 
these  simulation  results.  Appendix  B  contains  a  small,  randooily 
selected  sample  of  tha  output  data  produced  during  simulation  Run  #7c 
from  time  t  1234  seconds  to  t  «  1278  seconds. 

5.2.1  Run  #i,  tjtbmmd  ■  90,  120,  Tha  results  of  Row  #1  wore  .'r>t 
especially  good.  Tha  problem  arose  early  whan  tha  CMMCA  offset  '  tha 
left,  turning  too  far  and  maintaining  a  diverging  heading  for  ‘  .ong. 
Both  maximum  range  and  maximum  right  azimuth  wara  exceeded  for  long 
periods . 

5.2.2  Run  #2,  t^aAead  *  60,  90,  120,  The  radar  range  problem  was 
aggressively  attacked  on  two  frontat  by  rescaling  the  mapping  from 
actual  range  to  the  scaled  range  [-5,5],  and  by  changing  the  fuzzy  logic 
for  t_now  commanded  bank  using  radar  remge  as  an  input. 

The  new  range  mapoing  meant  that  the  range  became  fully  LN  or  I.R 
as  the  range  reached  the  buffer  region  (greater  than  14  nm  or  less  than 
€  nm).  The  new  range/ turn  direction  coo^nent  logic  gave  more  weight  to 
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Tabla  10  Results  for  Trial  Simulations  Using  Vsurious  Combinations  of 
Fuzzy  Logic  and  Look  Ahead  Times 


Profile 

& 

CM  bank 

Limit 

(percent 

within) 

1  Loo) 

eo 

n 

c  Ahead 

90 

rime 

120 

|r 

1  Change  from 

1  Previous  Ro'; 

A  &  20* 

range 

azimuth 

elevation 

j 

e^.e 

7b. 3 
100.0 

69.1 

74.9 

74.9 

(1) 

I 

A  &  20” 

range 

azimuth 

elevation 

100.0 

83.5 

100.0 

100.0 

84.4 

100.0 

100.0 

85.8 

100.0 

(2) 

map  of  radar 
range  to  [-5,5]; 
range  logic 

A  6  20” 

range 

azimuth 

elevation 

100.0 

84.2 

100.0 

(3) 

set  membership 
functions 

A  &  20” 

range 

azimuth 

elevation 

100.0 

87.1 

100.0 

(4) 

turn  offset 
logic 

B  &  20” 

range 

azimth 

elevation 

100.0 

81.2 

100.0 

(5) 

none 

A  &  20” 

range 

azimuth 

elevation 

100.0 

100.0 

100.0 

(6) 

turn  offset 
logic; 
scaling; 

C  £  20” 

range  1 
azimuth  | 
elevation  | 

100.0 

90.3 

99.8 

100.0 

93.0 

100.0 

100.0 

■MM 

(7) 

none 

C  £  30” 

range  I 
azimuth  D 
elevation  1 

100.0 

92.0 

100.0 

84.9 

79.0 

95.4 

82.7 

78.6 

97.2 

<a, 

none 

radar  range  as  it  approached  its  limits  than  in  the  previous 
formulation.  In  particular,  a  ranae  of  either  '  r  LP  now  resulted  in 
a  large  output  bank  from  this  logic  component,  'ih'-t  c__now  and  the  net 
(t_now  vs  t_next)  combining  logic  were  also  modifiev)  to  give  more  weight 
to  any  t_now  component  or  combined  Uf  or  LP  bemk  angle.  The  improvement 
was  immediate  and  obvious,  as  shown  in  Row  #2.  For  all  subsequent 
trials  with  the  CM  at  20  degrees  of  bank  the  range  limits  were  never 
violated. 

Ncn<r  HCA  scaling  was  also  used  to  keep  the  CKMCA  from  turning  too  • 
far  left  and  to  turn  back  towards  the  CM  when  necessary.  A  ten  percent 
improvement  across  all  look  ahead  times  was  noted,  although  the  now 
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rang*  logic  may  have  eontributad  aa  much  to  tha  asimuth  improvaraant  aa 
tba  aaimuth  logic  itaalf,  by  forcing  tha  CMMCA  to  turn  towarda  tha  CM  aa 
■ax lama  ranga  waa  approachad. 

A  foraahadowing  of  futura  problama  waa  alao  aaan  at  tha  and  of  tha 
aiamlation  (aaa  a.g.,  paga  SI,  Appandix  A).  For  all  thraa  look  ahaad 
tiaas,  tha  CMMCA  anda  tha  aiamlation  with  %  larga  haading  away  from  tha 
CM  and  no  ttmmpt  to  oorract  back.  Thia  could  potentially  dagrada  tha 
CNNCA  parfonaanca  if  tha  CM  wara  to  aiaka  another  turn. 

Bowavar,  ainca  tha  CM  flight  path  haa  ended,  tha  haading 
divarganoa  may  aimply  ba  an  and  af/act.  A  poaaibla  aolution  would  bo  to 
artificially  oxtand  tha  CM* a  path  in  a  atraight  line  beyond  ita  final 
poaition  for  a  diatanca  equal  to  tha  look  ahaad  time.  Thia  would 
prorida  a  virtual  ;!light  path  for  tha  CMMCA  and  bring  it  to  a  more 
raaoonabla  final  trajectory. 

8.3»3  Aun  #J,  t^ahaad  ■  SO.  Row  #3  ahowa  tha  raault  of  changing 
tha  sat  ■awbarahip  functions  for  tha  purpoaa  of  decreasing  tha  CMMCA 
offset  and  improving  tha  asiamth  problem.  Only  tha  functions  for  LM  and 
LF  wars  ohangod;  they  wars  shiftad  clightly  to  fores  aarllar  novsmant 
into  thosa  sate.  This  change  did  rot  have  much  affect.  While  tha 
aaimuth  limit  error  had  the  same  value,  the  CMMCA  actually  offset 
earlier,  more,  and  longer.  Xt  did  turn  back  more  about  midway  through 
the  turn,  and  alamst  eliminated  tha  haading  divergence  at  and  game. 

8,2,4  ^Aua  #S,  C^ahaad  ■>  80.  Row  #4  raprasants  a  logic  change  to 
stop  tha  amount  and  length  of  tha  CMMCA* a  offset  away  from  the  CM.  The 

i 

ehanga  was  pair formed  exclusively  to  the  t  now  combining  Icgic,  and  amde 

1 

tha  twn  oomponants  approximately  equal  in  weight  when  combined.  Thia 

1 

was  partially  suooassful.  Tha  CMMCA  did  not  offset  excessively  this 
tliM,  althoughiit  was  still  alow  to  turn  back  towarda  tha  CM  as  tha 
asiauth  limit  Was  exceeded.  Alao,  tha  CMMCA  did  not  offset  until  fairly 
late,  thus  it  did  not  build  turning  room  early.  While  this  waa  dua 
partly  to  tha  small  look  ahead  value  of  only  60  saoemds  in  thia 
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simulation  run,  mors  likely  the  continuing  problems  were  because  of  a 
errors  introduced  into  the  logic  rules  by  mistake  in  this  run. 

5.2.5  Rvui  #5,  t_Ahoad  -  60.  The  logic  rule  error  was  corrected. 
Because  the  offset  and  end  game  problems  had  been  reduced  both 
quantitatively  and  qualitatively,  and  because  of  the  effect  of  the  small 
look  ahead  time  on  the  offset,  the  CHMCA  was  run  through  the  much  more 
complicated  profile  B  of  two  linked  270  degrees  turns  (Row  #5). 

Analysis  of  the  results  showed  tt#o  problems.  First,  the  CMMCA  was  not 
offsetting  early  enough  (look  ahead  time,  again)  and  then  turning  too 
far  and  too  long.  Second,  and  of  major  importance,  the  CMMCA  was 
failing  to  offset  properly  following  the  first  CM  turn  as  the  CM  entered 
its  second  turn. 

5.2.6  Run  #tf,  t_a/iead  >  60.  Row  #6  shows  the  results  following  a 
change  to  all  three  factors.  The  range  mapping  was  changed  back  to  the 
original,  where  the  scaling  was  fully  reached  at  fi^*e  and  fifteen  miles, 
not  at  the  buffer  boundaries.  This  effect  would  be  better  captured  in 
the  logic  rules.  The  t__now  combining  logic  was  updated  to  do  this. 

The  turn  logic  was  reexamined  and  changed  to  end  the  excessive 
offset  by  the  CMMCA  that  was  causing  the  azimuth  limit  to  be  exceeded 
early  in  the  profile.  The  t__now  logic  was  modified  slightly  to  increase 
the  response  to  azimuths  approaching  the  limits.  The  t_next  fuzzy  logic 
was  changed  significantly,  in  that  no  t_next  outputs  wars  allowed  to  be 
Ul  or  LP.  These  changes  forced  the  CMMCA  to  respond  less  to  t_next 
outputs.  Hence  the  CMMCA  would  still  offset,  but  on  a  smaller  scale, 
not  turning  away  from  the  CM  as  much,  and  much  more  responsive  to  the 
need  to  turn  back.  These  same  changes  allowed  tho  CMMCA  to  create  an 
offset  for  the  next  maneuver  after  completing  the  previous  maneuver. 

Thus  the  CMMCA  should  now  take  better  heed  of  CM  otaneuvers  to  sot  itself 
up  prior  to  the  CM  going  into  its  next  maneuver. 

Run  #6  shows  a  large  deviation  in  :ponition  and  heading  at  the  end 
of  the  run.  However,  it  was  again  felt  that  this  was  due  to  end  effects 
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aa  diacuaaad  for  Run  #2.  If  thla  la  an  and  affact,  than  it  should  not 
causa  problems  in  the  transitions  batwaan  CM  manauvers. 

5.2.7  Run  #7,  t^ahmnd  >  60,  80,  120.  Because  the  results  of  the 
changes  made  in  Run  #6  ware  encouraging  on  the  simple  profile,  profile  C 
was  triad.  The  results,  as  shown  in  Row  #7,  damonstratad  ii  further  tan 
percent  improvement  in  asimuth  results,  even  at  the  smallest  look  ahead 
value.  As  look  ahead  time  increased,  corresponding  to  allowing/forcing 
the  CMMCA  to  act  earlier,  the  CMMCA  performance  improved.  A  look  ahead 
tiM  of  120  seconds  provided  100%  coverage  of  the  CM  throughout  the 
entire  profile. 

5.2.8  Run  tS,  tjthmttd  >  60,  90,  120.  As  a  test.  Profile  C  was 
rerun  with  the  CM  using  30  degrees  of  bank  in  all  turns  (Row  #8).  This 
resulted  in  a  severe  fall  off  in  CMMCA  performance  at  all  values  of  look 
ahead  time.  The  degradation  wait  least  severe  at  the  smallest  look  ahead 
tiiM  of  60  seconds,  probably  due  to  tne  fact  that  the  CM  was  turning  so 
rapidly  that  the  longer  look  ahead  times  were  not  allowing  the  CMMCA  to 
respond  quickly  enough  to  CM  r/neuvers. 

5.3  Computer  Run  Times 

During  early  atages  of  the  simu.'  «tion,  prior  to  incorporation  of 
the  fussy  logic  set  point  calculations  the  simulation  ran  much  faster 
thsui  real  tiiaa  on  both  the  SPARCstation  2  and  the  PC.  The  later 
simulation  efforts  were  carried  out  entirely  on  the  PC.  At  the  final 
form  of  the  simulation,  including  all  set  point  calculations,  the  system 
ran  at  almost  exactly  half  of  real  tisie.  That  is,  the  shortest  profile 
(profile  A,  442  seconds  of  simlation  time)  t  n  in  15  sdnutes,  while  the 
longeet  (profile  C,  1650  seconds  of  simulation  time),  took  slightly  over 
one  hour.  See  Table  11  for  anre  details. 

The  simulation  run  time  appeared  to  be  directly  proportional  to 
the  length  of  the  CM  profile.  This  is  a  big  improvement  over  the 
pr«»vioua  thesis  efforts,  where  run  time  seemed  to  increase  exponentially 
with  profile  length.  The  run  time  could  be  increased  several  fold  by 
relatively  minor  changes.  First,  the  Natlab  coda  could  be  better 
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Tabla  11  CM  Flight  Duratioha  and  Simulation  Timoa  and  Simulation 
Slow-Down  Performance  Ratio 


1  Simulation 

"Real" 

Simulation 

Ratio  of  Run  Time  to 

|_Run  Number 

Tima 

Run  Time 

Real  Time 

lb 

442.0 

861.7 

1.9tl 

Ic 

442.0 

939.2 

2.1tl 

2a 

442.0 

878.6 

2. Oil 

2b 

442.0 

860.4 

1.9tl 

2c 

442.0 

888.4 

2. Oil  1 

3a 

442.0 

855.6 

1.9il 

4a 

904.0 

1774.9 

2. Oil 

5a 

442.0 

865.8 

2. Oil 

1  6a 

1850.0 

3500.9 

1.9il 

- 

1850.0 

3548.4 

1.9il 

,o 

1529.0 

2964.2 

1.9il 

1  a.* 

1529.0 

2863.7 

1.9il 

1  Sb 

1529.0 

2948.7 

1.9tl  1 

optimized  for  speed.  Second,  converting  the  H-files  to  C  or  FORTRAN 
would  speed  up  the  simulation.  Third,  eliminating  the  unnecessary 
output  (used  for  debugging,  mostly)  would  also  speed  the  simulation. 
Finally,  using  a  workstation  instead  of  a  PC  would  probably  speed  up  the 
simulation  time  by  an  order  of  magnitude. 

An  additional  highly  important  factor  affects  this  simulation  as 
far  as  run  time  is  concerned.  Simulation  overhead  can  take  up  a 
significant  fraction  of  the  actual  CPU  time  used.  To  equate  simulation 
run  time,  therefore,  to  the  actual  speed  of  an  onboard  aircraft 
autopilot  would  be  seriously  misleading.  The  onboard  system  would 
receive  a  real  time  data  stream  consisting  of  the  CMMCA’s  inertial 
position,  velocity,  euler  angles,  radar  range  and  gimbal  angles,  etc. 

The  aifflulation'a  computation  of  these  values  would  be  eliminated, 
resulting  in  a  huge  reduction  in  the  number  of  computations. 


a 
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VI,  Conclusions  and  Roconanendatlons 


6,1  ConcluMlona 

This  thasia  haa  ahovm  that  tha  OfACA  tracking  problam  can  ba 
aolvad  in  naarly  raal  tim.  With  inprovamanta  to  tha  cocsputar  cod*,  aa 
diaouaaad  in  aaction  5.3,  tha  aimulation  ahould  ba  aaaily  implanantabla 
in  battar  than  raal  tima. 

Tha  naw  approachaa  to  tha  CHMCA  tracking  problam  takan  in  thia 
thaaia  ahow  good  raaulta  and  graat  promiaa.  Tha  kaya  to  thia  approach 
wara  thraa-foldi  1)  accapt  CM  poaitiona  anywhara  in  tha  radar  anvalopa 
inataad  of  alwaya  forcing  tha  CM  back  to  tha  noaiinal  daairad  poaition; 

2)  braak  tha  tracking  into  a  aariaa  of  abort  tracking  aolutiona, 
changing  avary  FTUT  aaconda;  and  3)  uaa  fumy  logic  to  cooputa  tha  naxt 
aat  point. 

rutay  logic  auccaadad  bacauaa  of  a  numbar  of  factor a.  It  allowad 
an  accurata  idantification  of  tha  problam  and  uaad  Morkabla  input-output 
ralationa  (i.a.,  BCA,  aaimuth,  ato.).  Tha  analog  to  aoala  mappinga  and 
tha  aat  mambarahip  functiona  tiara  alao  workabla  and  propar. 
Xntarralationahipa  batwaan  all  varlablaa  ramainad  oonaiatant  throughout 
tha  fuzay  logic  davalopmant.  rinally,  tha  logic  rula  tablaa  wara  kapt 
aaall  and  aimpla,  anauring  that  thay  ramainad  claar,  intuitiva,  and  aaay 
to  modify. 

Thia  ia  not  to  aay  that  no  improvamanta  ara  poaaibla.  Diffarant 
or  additional  Tariablaa  ahould  ba  conaidarad,  along  with  diffarant 
valuaa  of  fTOT.  Tha  ahapa  and  poaition  of  tha  fuaay  aat  mambarahip 
funotiona  and  tha  mappinga  from  analog  to  aoalad  values  arm  alao  likaly 
eandidataa  for  ohanga  and  improvamant.  All  thaaa  factors  had  a 
significant  impact  on  tha  CMKCA  flight  path,  and  oonsaquantly  on  tha  CM 
radar  oovaraga  providad. 

Tha  raaulta  in  tha  last  two  rowa  of  Tabla  10  show  tha  ehangaa  that 
ooour  as  tha  look  ahaad  tima  is  variad.  Xt  is  not  elaar  what  valua  is 
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b«st;  an  axperiancod  pilot  Bub-consclouely  uoos  many  look  ahr  .Imas, 
up  to  aavaral  minutea  in  the  future.  Therefore,  it  eeeme  reai  a  vie  to 
believe  that  instead  of  one  optimal  look  ahead  time,  significanv 
improvement  would  occur  if  multiple  look  ahead  timee  were  incorpo  ted, 
perhaps  based  on  CM  maneuvers,  but  more  appropriately  within  the  fu  vv 
logic  decision  tables  themselves. 

There  are  at  least  tm  consequences  of  the  fact  that  the  true 
parameter  values  ware  not  uaedt  1)  the  true  values  will  need  to  bo  found 
and  input  for  actual  implementation  in  autopilot  form;  2)  the  results 
may  be  biased  in  some  unknown  direction,  or  may  differ  in  a  random 
fashion  from  truth.  Hence  the  simulation  will  need  to  be  closely 
scrutinized  following  the  incorporation  of  these  true  parameter  values. 

The  penalty  function  and  dynamic  programming  approaches  to  this 
problem  suffer  from  major  difficulties  that  have  been  eliminated  here. 
The  solution  time  varies  directly  with  profile  length,  not 
exponentially.  This  is  because  the  former  approaches  used  iterative 
methods  seeking  solution  convergence.  This  method  does  not  iterate,  so 
does  not  have  problems  caused  by  failure  of  the  solutions  to  converge. 

6,2  Hecomswiidacions 

6.2.1  Program  Input.  The  input  method  consisted  of  an  ASCII  file 
of  circular  and  straight  segments.  The  Cm  was  assumed  to  be  in  constant 
bank  while  turning  and  to  have  constant  airspeed.  A  user  friendly, 
efficient  flight  path  data  input  method  is  needed,  based  on  the  actual 
information  provided  to  the  aircrews.  Kmphaiis  must  be  placed  on  making 
both  the  data  entry  and  simulation  results  simple,  quick  and  intuitive; 
if  not,  then  aircrews  will  not  use  this  program. 

6.2.2  Puasy  Logic.  The  fuzzy  logic  developed  in  this  thesis 
trorks  well  for  CM  profiles  at  small  bank  angles.  However,  the  solution 
breaks  do«m  as  the  CM  bank  increases.  As  discussed  above,  the  fuzzy 
logic  needs  to  be  expanded  to  several  look  ahead  times.  A  reasonable 
approach  might  be  tc>  use  60  and  90  seconds  or  60,  90,  and  120  seconds; 
further  experimentation  should  provide  guidance. 
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A  aacond  maans  of  Improving  tha  fussy  logic  would  ba  to  changa  tha 
mapping  from  the  analog  to  tha  scaled  [-5,5]  valuas.  Also,  changing  tha 
locations  of  tha  fussy  sat  mambarshlp  functions,  or  parhaps  adding  two 
mora  functions  for  Medium  Positive  (MP)  and  Medium  Negative  (MN)  might 
help. 

6.2.3  CNMCA  Pmrforrnaacm.  Tha  CKMCA  had  no  problem  tracking  tha 
CM  whan  tha  CM  maintained  a  constant  airspeed.  Hotravar,  tha  fussy  logic 
should  bo  modified  to  allow  the  CMMCA  to  change  spaed,  but  still  attempt 
to  keep  spaed  changes  small.  Since  turn  radius  depends  on  tha  square  of 
tha  spaed,  relatively  small  changes  In  spaed  might  greatly  Increase  tha 
CMMCA' s  ability  to  track  the  CM. 

One  other  problem  occurred  with  tha  CMMCA  turn  performance.  The 
CMMCA  bank  angle  accelerations  were  occasionally  very  oscillatory, 
usually  when  the  set  point  commanded  bank  angle  was  near  sero.  As  soon 
as  the  CMMCA  turned  slightly,  the  command  would  reverse  direction  (see 
the  discussion  In  section  2.6.4).  This  could  be  overcome  by  either  a 
second  set  of  fussy  logic  tables,  or  by  limiting  the  CMMCA 's  maximum 
bank  angle  or  bank  angle  acceleration  when  near  the  desired  state. 

This  thesis  used  a  model  with  no  noise  present.  Adding  noise, 
especially  to  the  range  and  angles  supplied  by  the  radar,  would  greatly 
increase  the  realism  of  the  simulation. 

6.2.4  aiaulmtion  Times.  The  values  of  sanqple  time  (1  second), 

FTUT  <10  seconds)  and  look  ahead  time  <60,  90,  or  120  seconds)  were 
chosen  for  convenience  and  because  they  seemed  about  the  right  else. 

There  Is  no  reason  to  believe  that  other  values  might  not  «rork  better; 
additional  effort  should  go  Into  an  examination  of  different  simulation 

tlSMS. 
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Appendix  A:  Plots  of  Simulation  Output 

Bach  flgura  is  a  plot  of  the  CM  and  CMHCA  ground  track  over  the 
entire  simulation  run  time.  In  addition,  a  line  is  drawn  at  intervals 
of  60  seconds  from  the  CHMCA  to  the  CM.  This  aids  in  interpreting  the 
plot,  and  also  graphically  dasonstrates  the  range  and  acimuth  at  one 
minute  intervals. 

The  symbology  on  each  graph  is  the  same: 

CMMCA  ground  tracks  solid  line; 

"o"  marks  the  CHMCA  position  every  60  seconds 

CM  ground  tracks  dot-dashed  line; 

"x"  marks  the  CM  position  eveiry  60  seconds 

Line  of  sight  from  CMMCA  to  CMs  dotted  line; 
shown  every  60  seconds 
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CNNCAi  solid  lino;  ”0”  svsry  60  seconds 
CMt  dot'-dash  lino;  "Z”  every  60  seconds 
CXKCA  to  CM  Line  of  Sights  dotted  line 


Figure  24  Plot  of  Resales  for  Simulation  Run  #2b 
Look  Ahead  Time  ■  90  seconds 
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Figure  29  Plot  of  Results  for  Simulation  Run  #6a 
Look  Ahead  Time  ••  60  seconds 
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rignr*  31  Plot  of  Results  for  Simulation  Run  #7b 
Look  Ahead  Tims  ■  90  seconds 
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Appendix  B:  Numerical  Output  of  the  Simulation 

The  full  output  from  one  simulation  run  of  profile  C  is  326K 
bytes.  Because  the  amount  of  data  is  immense,  only  a  small, 
representative  sample  of  the  output  for  Run  #7c  is  presented  here. 


Seuaple  of  the  CM  states: 


Time 

Position 

Bank 

Velocity 

Roll 

X 

Y 

Z 

Angle 

X 

Y 

Z 

Rate 

1234 

267911.17 

-208467.09 

-1000.00 

0.00 

-676.15 

12.66 

0.00 

0.00 

1235 

267235.15 

-208448.58 

-1000.00 

0.00 

-675.85 

24.36 

0.00 

O.CJ 

1236 

266559.53 

-208418.37 

-1000.00 

0.00 

-675.35 

36.06 

0.00 

0.00 

1237 

265884.51 

-208376.46 

-1000.00 

0.00 

-674.65 

47.76 

c.oo 

0.00 

1238 

265210.29 

-208322.85 

-1000.00 

0.00 

-673.75 

59.47 

G.OO 

0.00 

1239 

264537.08 

-208257.52 

-1000.00 

0.00 

-672.64 

71.18 

0.00 

0.00 

1240 

263865.07 

-208180.49 

-1000.00 

0.00 

-671.33 

82.89 

0.00 

0.00 

1241 

263194.48 

-208091.74 

-1000.00 

0.00 

-669.82 

94.61 

0.00 

0.00 

1242 

262525.50 

-207991.27 

-1000.00 

0.00 

-668.10 

106.33 

0.00 

0.00 

1243 

261058.34 

-207879.07 

-1000.00 

0.00 

-666.18 

118.06 

0.00 

0.00 

1244 

261192.84 

-207757.10 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1245 

260527.67 

-207633.17 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1246 

259862.50 

-207509.25 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1247 

259197.33 

-207385.32 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1248 

258532.16 

-207261.40 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1249 

257866.99 

-207137.47 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1250 

257201.82 

-207013.55 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1251 

256536.65 

-206889.62 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1252 

255871.48 

-206765.70 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1253 

255206.31 

-206641.77 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1254 

254541.14 

-206517.85 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1255 

253875.97 

-206393.92 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1256 

253210.80 

-206270.00 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1257 

252545.63 

-206146.07 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1258 

251880.46 

-206022.15 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1259 

251215.29 

-205898.22 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1260 

250550.12 

-205774.30 

-1000.00 

0.00 

-665-17 

123.93 

0.00 

0.00 

1261 

249884.95 

-205650.37 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1262 

249219.78 

-205526.45 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1263 

248554.61 

-205402.52 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1264 

247889.44 

-205278.60 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1265 

247224.27 

-205154.67 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1266 

246559.10 

-20.5030.75 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1267 

245893.93 

-204906.82 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1268 

245228.76 

-204782.90 

-1000.00 

0.00 

-665.17 

123.93 

c.oo 

0.00 

1269 

244'j63.59 

-204658.97 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1270 

243898. A2 

-204535.05 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1271 

243233.25 

-204411.12 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1272 

242568.08 

-204287.20 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1273 

241902.91 

-204163.27 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1274 

241237.74 

-204039.35 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1275 

240572.57 

-203915.42 

-1000-00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1276 

239907.40 

-203791.50 

-1000.00 

0  00 

-665.17 

123.93 

0.00 

0.00 

1277 

239242.23 

-203667.57 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 

1273 

238577.06 

-203543.64 

-1000.00 

0.00 

-665.17 

123.93 

0.00 

0.00 
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Sample  of  the  CMMCA  states: 


Tima 

Poaition 

Velocity 

Roll 

X 

Y 

Z 

Angla 

X  y 

Z 

Rate 

1234 

304282.98 

-178146.17 

-29000. CO 

-30.13 

-14.81  -674.94 

O.OG 

0.10 

1235 

304258.84 

-178820.82 

-29000.00 

-30.05 

-33.45  -674.27 

0.00 

0.06 

1236 

304216.10 

-179494.54 

-29000.00 

-30.00 

-52.02  -673.09 

0.00 

0.03 

1237 

304154.82 

-180166.83 

-29000.00 

-29.98 

-70.53  -671.40 

0.00 

0.01 

1238 

304075.06 

-180837.18 

-29000.00 

-29.98 

-88.97  -669.21 

0.00 

0.00 

1239 

303976.89 

-181505.08 

-29000.00 

-29.98 

-307.35  -666.51 

0.00 

0.00 

1240 

303860.38 

-182170.03 

-29000.00 

-29.98 

-125.65  -663.30 

0.00 

-0.01 

1241 

303725.66 

-182831.53 

-29000.00 

-29.40 

-143.73  -659.62 

0.00 

1.40 

1242 

303573.21 

-183489.17 

-29000.00 

-28.56 

-161.04  -655.6’ 

0.00 

0.37 

1243 

303403.70 

-184142.62 

-29000.00 

-28.49 

-177.95  -651.21! 

0.00 

-0.15 

1244 

303217.32 

-184791.46 

-29000.00 

-28.76 

-194.83  -646.37 

0.00 

-0.35 

1245 

303014.00 

-185435.20 

-29000.00 

-29.13 

-211.81  -641.01 

0.00 

-0.37 

1246 

302793.65 

-186073.30 

-29000.00 

-29.47 

-228.90  -635.11 

0.00 

-0.30 

1247 

302556.19 

-186705.24 

-29000.00 

-29.73 

-246.03  -628.67 

0.00 

-0.21 

1248 

302301.61 

-187330.47 

-29C00.00 

-29.89 

-263.12  -621.71 

0.00 

-0.13 

1249 

302029.99 

-187948.50 

-29000.00 

-29.99 

-280.10  -614.25 

0.00 

-0.07 

1250 

301741.47 

-138558.81 

-29000.00 

-30.03 

-296.91  -606.30 

0.00 

-0.03 

1251 

301436.23 

-189160.94 

-29000.00 

-30.04 

-313.52  -597.88 

0.00 

0.00 

1252 

301114.50 

-189754.42 

-29000.00 

-30.04 

-329.89  -589.01 

0.00 

0.01 

1253 

300776.53 

-190338.80 

-29000.00 

-30.03 

-346.01  -579.69 

0.00 

0.01 

1254 

300422.57 

-19091.3.65 

-29000.00 

-30.02 

-361.86  -569.93 

0.00 

0.01 

1255 

300052.91 

-191478.52 

-29000.00 

-30.01 

-377.42  -559.74 

0.00 

0.01 

1256 

290667.83 

-192032.99 

-29000.00 

-30.01 

-392.70  -549.13 

0.00 

0.00 

1257 

299267.62 

-192576.65 

-29000.00 

-30.00 

-407.67  -C38.il 

0.00 

0.00 

1258 

293852.59 

-193109.08 

-29000.00 

-30.00 

-422.33  -526.68 

0.00 

0.00 

1259 

298423.06 

-193629.88 

-29000.00 

-30.00 

-436.67  -514.85 

0.00 

0.00 

1260 

297979.36 

-194138.66 

-29000.00 

-30.00 

-450.68  -502.64 

0.00 

0.00 

1261 

297521.81 

-194635.03 

-29000.00 

-29.92 

-464.35  -490.04 

o.oo 

0.74 

1262 

297050.85 

-195118.68 

-29000.00 

-29.45 

-477.48  -477.26 

0.00 

0.24 

1263 

296567.02 

-195589.47 

-29000.00 

-29.35 

-490.12  -464.27 

0.00 

-0.02 

1264 

296070.73 

-196047.10 

-29000.00 

-29.45 

-502.41  -450.93 

0.00 

-0.14 

1265 

295562.30 

-196491.20 

-29000.00 

-29.60 

-514.41  -437.20 

0.00 

-0 . 16 

1266 

295042.02 

-196921.37 

-29000.00 

-29.75 

-526.10  -423.06 

0.00 

-0.13 

1267 

294510.21 

-197337.20 

-20000.00 

-29.86 

-537.46  -408.53 

0.00 

-0.10 

1268 

293967.22 

-197738.31 

-2  -000.00 

-29.94 

-548.46  -393.64 

0.00 

-0.06 

1269 

293413.42 

-198124.36 

-29000.00 

-29.99 

-559.08  -378.41 

0.00 

-0.03 

1270 

292849.20 

-138495.02 

-29000.00 

-30.01 

-569.28  -352.87 

0.00 

-0.01 

1271 

292274.99 

-198850.00 

-29000.00 

-30.02 

-579.07  -347.05 

0.00 

0.00 

1272 

291691.24 

-199189.05 

-29000.00 

-29.44 

-588.35  -331.07 

0.00 

1.29 

1273 

291098.60 

-199512.34 

-29000.00 

-27.52 

-596.75  -315.67 

0.00 

2.51 

1274 

290498.14 

-199820.85 

-29000.00 

-24.50 

-603.96  -301.64 

0.00 

3.50 

1275 

289891.12 

-200116.28 

-29000.00 

-20.57 

-609.83  -289.59 

0.00 

4.32 

1276 

289278.93 

-200400.83 

-29000.00 

-15.91 

-614.33  -279.93 

0.00 

4.99 

1277 

288662.93 

-200677.04 

-29000.00 

-10.64 

-617.45  -272.97 

0.00 

5.53 

1278 

288044.48 

-200947.74 

-29000.00 

-4.88 

-619.22  -268.93 

0.00 

5.93 

1279 

287424.94 

-201215.93 

-29000.00 

1.29 

-619.63  -267.99 

0.00 

6.35 

1280 

286805.69 

-201484.80 

-29000.00 

7.79 

-618.61  -270.32 

0.00 

6.65 
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Sample  of  the  CMMCA  euler  angles: 


Time 

Heading' 

Pitch 

Bank 

1234 

268.74 

0.00 

-30.13 

1235 

267.16 

0.00 

-30.05 

1236 

265.53 

0.00 

-30.00 

123V 

264.00 

0.00 

-29.98 

1238 

262.43 

0.00 

-29.98 

1239 

260.85 

0.00 

-29.98 

1240 

259.27 

0.00 

-29.98 

1241 

257.71 

0.00 

-29.40 

1242 

256.20 

0.00 

-28.56 

1243 

254.72 

0.00 

-28.49 

1244 

253.23 

0.00 

-28.76 

1245 

251.71 

0.00 

-29.13 

1246 

250.18 

0.00 

-29.47 

1247 

248.63 

0.00 

-29.73 

1248 

247.06 

0.00 

-29.89 

1249 

245.49 

0.00 

-29.99 

1250 

243.91 

0.00 

-30.03 

1251 

242.33 

0.00 

-30.04 

1252 

240.75 

0.00 

-30.04 

1253 

239.17 

0.00 

-30.03 

1254 

237.59 

0.00 

-30.02 

1255 

236.01 

0.00 

-30.01 

1256 

234.43 

0.00 

-30.01 

1257 

232.85 

0.00 

-30.00 

1258 

231.27 

0.00 

-30.00 

1259 

229.70 

0.00 

-30.00 

1260 

228.12 

0.00 

-30.00 

1261 

226.54 

0.00 

-29.92 

1262 

224.99 

0.00 

-29.45 

1263 

223.45 

0.00 

-29.35 

1264 

221.91 

0.00 

-29.45 

1265 

220.36 

0.00 

-29.60 

1266 

218.80 

0.00 

-29.75 

1267 

217.24 

0.00 

-29.86 

1268 

215.67 

0.00 

-29.94 

1269 

214.09 

0.00 

-29.99 

1270 

212.51 

0.00 

-30.01 

1271 

210.94 

0.00 

-30.02 

1272 

209.37 

0.00 

-29.44 

1273 

207.88 

0.00 

-27.52 

1274 

206.54 

0.00 

-24.50 

1275 

205.40 

0.00 

-20.57 

1276 

204.50 

0.00 

-15.91 

1277 

203.85 

0.00 

-10.64 

1278 

203.48 

0.00 

-4.88 

1279 

203.39 

0.00 

1.29 

1280 

203.60 

0.00 

7.79 
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Sample  of  the  CMMCA  to  CM  range  and  radar  gimbal  angles 


Time 

Rang* 

Azimuth 

Blavation 

1234 

55011.51 

-55.30 

-6.57 

123S 

55068.66 

-54.93 

-6.73 

1236 

55123.54 

-54.55 

-6.86 

1237 

55176.08 

-54.18 

-6.98 

1238 

55226.19 

-53.80 

-7.09 

1239 

55273.79 

-53.42 

-7.19 

1240 

55318.79 

-53.03 

-7.30 

1241 

55361.13 

-52.60 

-7.88 

1242 

55400.97 

-52.18 

-8.65 

1243 

55438.58 

-51.84 

-8.80 

1244 

55475.02 

-51.53 

-8.68 

1245 

55514.31 

-51.19 

-8.50 

1246 

55557.03 

-50.82 

-8.36 

1247 

55602.67 

-50.42 

-8.30 

1248 

55650.76 

-49.97 

-8.32 

1249 

55700.88 

-49.50 

-8.41 

1250 

55752.65 

-49.01 

-8.54 

1251 

55SC5.72 

-48.50 

-8.71 

1252 

55859.78 

-47.97 

-8.90 

1253 

55914.50 

-47.42 

-9.10 

1254 

55969.51 

-46. 8G 

-9.30 

1255 

56024.81 

-46.29 

-9.52 

1256 

56079.83 

-45.70 

-9.74 

1257 

56134.42 

-45.09 

-9.98 

1258 

56183.33 

-44.47 

-10.22 

1259 

56241.32 

-43.84 

-10.47 

1260 

56293.17 

-43.19 

-10.73 

1261 

56343.66 

-42.51 

-11.05 

1262 

56392.67 

-41.78 

-11.64 

1263 

:i6440.12 

-41.10 

-11.98 

1264 

56485.90 

-40.43 

-12.20 

1265 

56529.82 

-39.76 

-12.41 

1266 

56571.68 

-39.06 

-12.63 

1267 

56611.33 

-38.34 

-12.90 

1268 

56648.60 

-37.59 

-13.20 

1269 

56683.39 

-36.82 

-13-54 

1270 

56715.62 

-36.02 

-13.91 

1271 

56745.21 

-35.21 

-14.30 

3272 

56772.14 

-34.27 

-15.04 

1273 

56796.54 

-33.03 

-16.47 

1274 

56818.86 

-31.54 

-18.38 

1275 

56839.72 

-29.79 

-20.59 

1276 

56859.87 

-27.77 

-22.94 

1277 

56880.12 

-25.48 

-25.33 

1278 

56901.35 

-22.94 

-27.67 

1279 

56924.50 

-20.15 

-29.92 

1280 

56950.60 

-17.13 

-32.03 
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Appendix  L.  jtlab  M~ files  Used  Prior  to  the  Simulation 
This  appendix  containa  the  lietings  for  all  the  H-filea  used 
before  the  simulation  can  be  run.  These  files  include  the  CM  flight 
path  generation  files  and  the  simulation  set  up  files. 

The  flight  path  generation  files  arei 

1.  QSN  SAV.M 

2.  CMSHO.M 

3.  CMCXS.M 

4.  CMI.ZN2.M 

”GSN_SAV.M‘'  is  run  with  an  input  ASCII  file  as  described  in  Chapter  3. 

It  calls  the  other  three  files,  and  outputs  a  ".sav"  file  containing  all 
the  information  on  the  CM* a  ground  track,  accelerations,  headings  and 
bank  angles  needed  in  the  simulation. 

The  simulation  setup  files  aret 

1.  RtJNMB.K 

2.  RDMSIM.M 

3.  CMCASYS.M 

4.  CMSYS.M 

5.  SZMOAIH.M 

"ROMMS. K”  is  the  top  level,  menu  driven  file.  It  queries  the  user  for 
the  choice  of  CM  profiles  and  the  desired  look  ahead  time.  The  output 
of  these  files  is  the  optimal  control  gains,  CM  and  CMMCA  state 
matrices,  and  numerous  global  constants.  At  this  point,  the  simulation 
is  ready  to  be  run  from  inside  Simulink. 


Beam  Matlab  charactorei 

%  -  comment  character,  remainder  of  line  is  ignored 

I  -  used  At  end  of  line  to  prevent  Matlab  from  printing  the  results  of 
that  line  (to  the  screen); 
also  ends  rows  within  a  matrix 
-  exponentiation 

■«,<,>,<■,>•  -  logical  operators 

( , ]  >  delineate  matrices  and  vectors 
'  -  matrix  transpose; 

etert/end  of  text  string 
. . .  •  current  line  is  to  continued  on  next  line 
I  -  used  to  create  a  vector  with  default  spacing  of  one; 
e.g.,  9  ■  lt4  createa  the  vector  D  »  [1  2  3  4] 


I 
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Top  level  M  file  in  computing  and  eaving  ".eav"  files  for  use 
by  "runsim.m" 


GSN  SAV.H 
24  7an  93 
Randy  Nelson 


Osest  "cuignd.m,"  "spec_den.m, •  and  "tlma_fui6.m" 

Currently  callet  "cm.dat,”  ” cmshort.dat”  and  "cmlong.dat" 


Output  is  a  number  (three  as  of  now)  of  ".sav”  files  containing: 
n  X  5  matrix  of  CM  accelerations  (U), 

n  X  4  matrix  of  CM  headings,  x-y  positions  and  Bign(bank)  (cm_hpb), 
and  n  X  3  matrix  of  update,  reset  and  look  ahead  tii^s  (fuzzy~tJ^i°*) 

NOIiCi  if  you  want  to  prepare  a  single  data  file  for  use  by  the  simulation, 
run  "cmgnd.ffl"  on  the  ".dat”  file  and  than  run  "time_fuz.m" 
on  those  results  (remember,  no  arguments  to  either)~ 


*****  itat  of  files  to  use  for  possible  simulation  runs  ***** 
ile_liat  ■  ( 

•“  pathl' I 
'  path3 '  ] / 

'  path4  * ; 

'  path4  30'  ]; 


%  *****  Define  some  global  variables  here  (outside  of  "runsim.m'’)  ***** 

global  atart_8tep  look_ahsad  fuzsy_tlma  U  cm__hpb  max^ftut  max_reset 


atart^etep  >  10; 
nuffl^freqa  >32; 
nax^ftut  >10; 
Dax*~reset  >  max  ftut; 


%  do  a  pad  every  10  aeconda 
%  divide  apectrum  into  32  frc<juanciea 
%  Max  delta  ftut 

%  Max  delta  reaet  time  <>  max  delta  ftut 


for  row  >  It  size (file  liat) 

fnamaindex  >  find (file  list (row, t )•'  *); 
fnama  >  fila_li8t(row,7nameindex) ; 

(0,cm_hpb]  >~cmgnd(2,fname)  ;  %  uae  all  input  filea  in  turn 

fuzzy~tiiDa  >  tiM_fuz; 

eval(T'aave  '  fnama  '.aav  0  cm_hpb  fuzry_time’ ] ) ; 
end;  %  for  row  >  Ii8ize(file_li8t)  ~ 

clear;  ~ 


return; 


function  [accelBfCm  numa]  »  cmgnd( Flag, f name) 

%  ~  CatGND.M 

%  CMMCA  flight  path  generator  24  Jan  93 

%  Randy  nelson 

%  Top  level  H  file  in  generation  of  flight  p^ths. 

%  Uses  files  cmcir.m  and  cmline.m  for  arcing  and  straight  line 
%  portions  of  the  flight  path. 

%  Inputs  flag  is  used  to  skip  portions  of  "cmgnd.m” 

%  Flag  >  0  >>  from  user  at  Icbd  (do  all,  don't  save  output) 

%  Flag  >  1  >>  from  ''pwr_max.m”  (skip  plots,  filename  req,  cm_nuffls) 

%  Flag  a  2  ■>  from  *gan_aav.m''  (skip  plots, filename  req)  ~ 

%  fname  is  used  with  "pwr^max.m"  and  "gen_sav.m" 

%  Output  is  a  matrix  of  x  and  y  second  derivatives  (accels), 

%  and  n  X  4  matrix  of  CM  heading,  inertial  x  6  y  positions 
%  and  the  sign  of  the  CM  bank  angle  (cm_nums) 

%  throughout  CM  flight  time  (at  one  second  intervals) 

%  Format  of  input  data: 

%  id  value 

%  where 

%  /  ‘*'1  Right  Turn 

%  id  is  <  -1  for  a  Left  Turn 

%  \  0  for  a  straight  segment,  and 

%  value  is  #  degrees  to  turn,  or 

%  #  feet  to  proceed  in  straight  leg 

%  Flight  begins  at  origin,  heading  North  at  400  kts. 

%  in  iceeping  with  (the  bizarre)  tradition  that  X  is  North, 

%  X  is  Bast,  and  Z  is  down. 


%  set  up  constants  and  variables 


nm  ■  6076}  |  % 

maxBank  ■  20*pi/180}  % 

velocity  *  400*nm/3600/  % 

radiusCM  «  velocity^2/(32.2*tan(maxBank) ) ; 

heading  *  0}  % 

position  *  [0  0]}  % 

timestsp  *  1}  % 

pathstep  ■  (velocity  *  tlmestep);  % 

pathoffset  >0;  % 

pathplaca  ■  0;  % 

xy  ■  tl;  * 

xy2nd  -  (];  % 

timepts  •■  ( ] ;  % 


conversion  factor 
CM'S  nuuc  bank  angle 
CM  and  CMMCA 's  speed  in  ft/sac 
%  CM'S  nominal  turn  radius 
initially  heading  North 
initially  at  origin 
delta  t,  in  seconds 
feet  per  time  step 
correct  for  path  pts  not  exactly 
at  end  of  segment 
position  at  start  of  each  segment 
2xn  array  of  fit  path  positions 
2xn  array  of  second  derivatives 
ixn  array  of  discrete  time  pts 


%  •**•*  o«t  file  with  CM  flight  path  data  ***** 

if  (Flag  0) 

fname  -  input(['Hhat  is  the  name  of  the  CM  flight  path  data  file?'  10  ... 

'  [".dat"  will  be  appended]  '],'s'); 

end;  %  if  (Flag  0) 

disp( ( 'Loading  data  file  '  fname  '.dat']); 
aval ( [ ' load  '  fname  ' . dat ' ] ) ; 
f name«eval (aval ( ' fname ' ) ) ; 

[segs,0C]  >  niza(fname);  %  segs  is  #  flight  path  segments 


%disp( 'Working  ...') 
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for  Mg  >  lisogs  %  ona  loop  for  each  aegmani: 

%  First  divide  eegment  into  discrete  points  by  dividing  the 
%  segment  path  length  by  the  distance  flovm  ir  delta  t  seconds, 
if  fname(8eg,l)  »  0, 

seg_length  ■  fname(8eg,2) ;  %  length  for  straight  leg 

else 

seg_length  >  pi/180*radiuECM*fnaine(seg,2) ;  %  length  for  turning  leg 

and|~%  if  fnama{seg«l)  »  0 

path_len  »  seg_langth  -  pathoffset;  %  reduce  length  by  offset  into  seg 

numbstep  >  fixXpath_len/pathstep) ;  %  number  of  steps  in  this  leg 

round_len  >  numbstep*pathstep;  %  length  of  integral  #  of  steps 

pathpts  ■  ( [Ot numbstep] *pathstap) ' ;  %  points  along  path  segmenti  nxl 

pathpta  ■  (pathplace}*ones( pathpts)  +  pathpts;  %  add  offset 

if  fname(8eg,l)  »  0  %  a  straight  leg 

[heading,p08ition,seg_xy,seg_xy2nd]  >  ... 
cmlino( fnama( seg, 2 )7heading, position, pathpts, pathoffset ) ; 

else 

[heading, position, seg  xy,ssg_xy2nd]  >  ... 
cmcir(fnama(seg,l) ,?nama( seg, 2), heading,  . . . 

position, pathpts, pathoff set, radiuscat, velocity) ; 
and;  %  if  fnaffla(seg,l)  «  0 

xy  **  (xy/  **9  *  augment  xy  with  new  piece 

xy2nd  <■  (xy2n3;  aeg_xy2nd];  %  augment  xy2nd  with  new  piece 

timepts  B  (timepts;~pathpts] ;  %  same  for  timepts 

pathplace  >  pathateptpathpt8(length(pathpt9) ) ;  %  set  new  starting  pt 

pathoffset  *  path_lan  -  round^^lan;  %  what's  left  over 

end;  %  for  seg  *  iTsegs  " 

%  *****  array  of  [time,  x,  y,  s,  bank  angle;  same-dot-dot ]  ***** 

mccels  B  [timapts/velocity  xy2nd  saros (length (timepts) ,2) ] ; 


% 

%  *****  if  in  "cmgnd.m"  from  "pwr  max.m"  function  call,  exit  here 

%  wesee 

if  (Flag  B«  1) 

‘return;  %  accels  is  all  that’s  needed 

end;  %  if  (Flag  b«  i) 


%  *****  Compute  CM  heading,  inertial  position  and  signum(bank  angle)  ***** 

%  at  one  Mcond  intervals  throughout  flight 

vel  B  diff(xy);  %  velocity  approx  delta  position  (in  1  sec) 

val  B  [675.11  0;  vel]; 

hdg  B  ram(2*pi  +  atan2(vel(t,2),vol(t,l)),2*pi);  %  in  range  [0,2*pi] 

%  cm  bank  angle;  >1,0  or  1  for  loft  turn,  no  turn  or  right  turn 

w  B  length (hdg);  %  number  of  time  points  in  CM  heading/position  matrix 

bank  b  seros(w,l); 

for  i  B  2tw-l  %  in  middle  of  matrix 

bank(i)  b  hdg(i-M,l)>hdg(i-l,l) ; 
end;  %  for  i  b  2tw-l 

bank(l)  b  hdg(3)  -  hdg(l);  %  at  beginning  of  matrix 

bank(w)  b  hdg(w)  -  hdg(w-2);  %  at  end  of  matrix 

%  account  for  heading  change  of  360  degrees  as  CM  passes  thru  North 

baxdc  B  (abs(bank)  >  .17)  .*  sign(bank)  *  (>2*pi)  +  bank; 

bank  b  (abs(bank)  >b  .0017)  .*  bank;  %  any  change  <  .1  degrees  is  no 

change 

bank  B  eign(bank); 
cm_nums  b  [hdg  xy  bank]; 
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***** 


%  ie§@@8 

%  *«**«  if  in  "cmgnd.m"  ^rom  "gan  sav"  function  call,  just  axit  hare 

%  888888 
if  (Flag  <»  2) 

return;  %  don't  need  plots 

and;  %  if  (Flag  >»  2) 


%  A**************************************************************** 

%  Provide  plots  of  Cruise  Missile  flight  path  data,  if  desiredt 

%  ****************************«*«********»**«********«*****i****«** 

input ('Do  you  want  a  plot  of  the  second  darivativas  <y |N>?' , 's' ) ; 
if  (ans  ■■  'Y')  I  (ans  ••  'y') 

s  ■  max(max(xy2nd) )  .*  onesitimapts) ; 
clg; 

disp('Plot  of  second  darivativas  of  x  &  y  vs  tine.') 
subplot (2 11 ) ; 

plot(tinapts,xy2nd( t ,1) , ' tg' ,timept8, (s  -s] ) ; 
title('X  Acceleration  (inertial)  of  Cruise  Missile') 
subplot ( 212 ) ; 

plot(timepts,xy2nd( t ,2) , ' tr' ,tinapts, (s  -s] ) ; 
title('Y  Acceleration  inertial)  of  Cruise  Missile') 
xlt.bal  ( '  Tima  from  Start  (sac)') 
ylabel('  Acceleration  (feot/ssc/sec) ' ) 

end;  %  if  (ans  «•  Y) 

input ('Do  you  want  a  plot  of  the  flight  path  <Y|N>? ' , 's' ) ; 
shg; 

if  (ans  ••  'Y')  I  (ans  'y') 
clg; 

plot(xy( i ,2) ,xy( i ,1) , '-w* ) ;hold  on; 
for  jj  ■  lOt 10 t length (timepts) 
plot(xy(jj,2),xy(jj,l),'*w') 
end; 

plot(xy(l,2),xy(l,l),'*g'); 

plot(xy(langth(xy),2),xy(langth(xy),l), '*r');hold  off; 
titlo( 'Flight  Path  of  Cruise  Missile’) 
xlabelCY  distance  (feet)') 
ylabel('Z  distance  (feet)') 
end;  %  if  (ans  ■■  Y) 

return; 
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function  (finalI!DO,finalPOS,Beg_xy,8eg_xy2nd]  >  ... 

cmcir ( turnOlR, turnANGUS , inltHDO , initPOS , pathpts , pOFF , radius , vel ) 

%  CHCIR.M 

%  24  Jan  93 

%  Randy  Nelson 

%  Purpoaat  generate  a  cubic  smoothing  spline  with  initial  position^ 

%  initial  heading,  degrees  to  turn  and  turn  direction. 

%  Inputs t  4  scalars,  an  n  x  1  vector,  3  scalars 

%  turnOZR  is  -1  or  +1  ^or  left  or  right  turn, 

%  turnANOLB  is  number  of  degrees  to  turn, 

%  InitHDO  is  heading  of  CM  at  start  of  turn, 

%  initPOS  in  position  of  CM  at  start  of  turn, 

%  pathpts  is  vector  of  equally  spaced  points  along  the  CM's  path, 

%  pOFF  in  first  point  along  this  segment's  path  (since  discrete  points), 

%  radius  is  CM's  turn  radius, 

%  and  velocity  is  CM's  speed  (constant  throughout). 

%  Outputs t  2  scalars,  two  n  x  1  vectors 

%  finalHOO  is  heading  of  CM  at  end  of  turn, 

%  finalHDO  is  position  of  CM  at  end  of  turn, 

%  aeg_xy  is  vector  of  x  and  y  inertial  positions  every  second, 

%  and~aeg_xy2nd  is  vector  of  x  and  y  accelerations  at  one  second  intervals. 

%  Motet  pathpts  changed  internally  to  n+l  points  at  equal  angular  intervals, 

%  with  n  «  3  one  for  every  ten  degrees  of  turn. 

%  set  output  value  and  adjust  to  range  [0,360] 
finalBDO  a  reffl( InitHDO  +  turnAHGZJS!  *  turnOIR  *  3600,360); 

%  Mow  to  parameterize  the  curve  as  a  pair  of  functions  of  st 
%  xax(s)  and  y*y(s)  w/s  the  discrete  angular  step. 

%  compute  values  for  circular  path  parameters 


tangle  *  turnANOLB  *  pi/180; 
ihdg  a  InitHDO  *  pi/180; 


%  convert  to  radians 


ctraradius*  [cos(ihdg-fpi/2*tum0IR)  sin(ihdg'fpi/2*tum0IR)  ]  initPOS; 


if  tumOZR  a»  -1, 
startangle  *  -ihdg; 
finalangla  a  -ihdg  +  tangle; 

else 

startangle  ■  pi  -  ihdg; 
finalangla  a  startangle  -  tangle; 
and; 


%  left  turn 

%  using  degrees  from  standard  zero 
%  same  convention 
%  right  turn 


N  a  fix(tumAMOZ<B/10)  >3;  %  Number  of  break  points  in  interval. 

lalOiM];  %  i  a  0,1,2, .,.,H 

s  a  i*tanglo/N;  %  s  is  discrete  angular  step  in  radians, 

w  a  startangle  -  s^tumOIR;  %  w  is  step  from  start  to  final  angle. 

%  Discretize  x(w)  and  y(w) 

xy  a  (ctr(l)*ones(w) ',  ctr(2)*ones(w) ' ] '  ♦  radius*  [sin(w)'  cos(w)']'; 
finalPOS  a  (xy(l,M+i)  xy(2,M4'l)];  %  set  output  value 


%  Nov*  fit  spline  to  x(v*)  and  y(v*) 

ppx  >  C8api(vf,xy(l, i ) ) ;  %  get  pp  form  of  spline  for  x  (1  x  n  matrix) 

ppy  ■  csapi(w,xy(2, t ) ) ;  t  get  pp  form  of  spline  for  y 

%  Compute  2nd  derivative  splines  of  x(t)  and  y(t) 

pp2nd>[fnder(ppx,2) '  fnder(ppy,2) ' ];  %  return  an  n  x  2  matrix 

%  Values  of  points  along  path  converted  to  angular  displacement i 

pathpts  ■  (pathpts-»-(pOF?-pathpts(l)  )*ona9(pathpt8)  )*(l/radius) ; 
pathpts  •  (8tartangle*one8( pathpts)  ~  pathpts*turn01N) ; 

%  Compute  positions  along  the  flight  path 

seg_xy  ■  [ fnval (ppx# pathpts' ) '  fnval(ppy#pathpts' ) ’ ] ; 

%  Compute  values  of  2nd  derivatives  along  the  flight  path 
seg_^xy2nd  ■  (val''2/radiua*2)  *  ... 

(fnval(pp2nd(  t  #1) '  fpathpts* ) '  fnval(pp2nii(  t  #2) ' ,pathpta' )  ’  ]; 


return; 


104 


function  [finalHDG,£inalP0S,8eg  xy,seg_xy2nd]  >  ... 

cmllne ( dIstanceTinitHOG , initPOS , pathpta , pOFF ) 

%  CHLINB.H 

%  23  Jan  93 

%  Randy  Kelson 

%  Purpose t  generate  a  straight  line  given  the  starting  point 
%  and  the  line  length. 

%  No  default  assumptions;  need  all  three  values  as  input! 

%  Format  is 

%  1.  Distance  is  in  feet. 

%  2.  initHDG  is  in  compass  degrees  0  -  360 

%  (i.e.  0  «  North,  90  -  Bast,  180  -  South  and  270  -  N). 

%  3.  initFOS>[x,y]  in  feet. 

%  Now  to  parameterize  the  line  as  a  pair  of  functions 
%  of  St  x*x(s)  and  y«y(a)  w/s  the  discrete  step. 

finalBOG  «  initHDG;  %  set  output  value 

initHDG  >  initHDG  *  pi/ 180;  %  convert  to  radians 


%  •*«**  Compute  end  point  of  line  ***** 

K  ■>  5;  %  Number  of  break  points  in  interval. 

i>(0  1];  %  i  a  0,1;  start/end  of  line. 


xend  ■  initPOS  +  distance  *  [cos<initEDG)  sin( initHDG) ] ; 

finalPOS  >  xend;  %  set  output  value 

xy  ■  [initPOS*  xend');  %  2x2  matrix  of  start/end  of  line 

%  Now  fit  spline  to  x(w)  and  y(w) 

ppx  >■  csapi(i,xy(l, t ) ) ;  %  get  pp  form  of  spline  for  x 

ppy  ■  csapi(i,xy(2, I ) ) ;  %  get  pp  form  of  spline  for  y 

%  Compute  2nd  derivative  splines  of  x(t)  and  y(t)t 

pp2nd-[fnder(ppx,2) '  fnder(ppy,2) ’ ] ;  %  retuzti  an  n  x  2  matrix 

%  Values  of  points  along  path  converted  to  [Oil]  parameter 
pathptsl  »  (pathpts-«-(pOFF>pathpts(l))*oneB(pathpt8)); 
path|^s2  »  ^thptsl/max(pathptsl); 

%  Compute  positions  along  the  flight  path 

Beg_xy  ■  [ fnval (ppx, pathptsl ') '  fnval (ppy, pathptsl ; 

%  Compute  values  of  2nd  derivatives  along  the  flight  path 

seg_xy2nd  «  [fnval(pp2nd(i,l} ',pathpts’) '  fnval{pp2nd( i ,2) ' ,pathpts' ) ' ] ; 

return; 
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%  RONMR.M 

%  18  Dec  92 

%  Randy  Nelson 

%  M  File  to  execute  simulation 
%  Uses  saved  missile  data  in  ".sav*  files  from 
%  "pathl.sav"  "pathl.sav"  ■path4.8av"  "path4_30 . sav" 

% 

%  Calls  runsim  to  set  simulation  parameters  and  ask  about  a  diary  output, 
clear ;clc; 

di8p([10  'Nelcome  to  the  CMNCA  simulation  system.'  10]) 

disp(['You  have  the  choice  of  eight  preset  cruise  missile  flight  paths,'  ... 


10  'or  you  may  select  one  of  your  own.'  10]) 
di8p( [ 'Bachman' '8  profile  1  (path  A,  a  180  degree  right  turn)?  -tl>*  . 

10  'Bachman' '8  profile  3  (path  B,  2x  270  degree  turns)?  <2>'  . 

10  'Bachman' '8  profile  4  (path  C,  a  number  of  turns)?  <3>'  . 

10  'Bachman' '8  profile  4  (using  30  degrees  of  bank)?  <4>'  . 


10  'Your  choice  (you  will  need  to  provide  a  CM  flight  profile)?  <5>’ 

10  •  (or  Ctrl-C  to  exit)']) 

bad  input  >1; 
whiXe  bad_input 

f nuffl>in^t ( ' Make  your  choice  by  selecting  a  number  from  1-9,  nowi  ’,'8'); 
bad_input  *0; 
if  Jfnum  ■»'!') 

file  ■  'pathl'; 
elseif  ( f num  ' 2 ' ) 

file  •  'path!'; 
elseif  ( f num  ' 3 ' ) 

file  ■  'path4'; 
elseif  (fnuffl  '4') 

file  «  •path4_30'; 
elseif  ( f num  'S') 

file  "  input ([10  'Enter  the  file  name  containing  the  flight  data.'  ... 

10  '(A  default  extension  of  ".sav"  is  always  added.)  '],'a')| 
if  ((file  '  ']  ««  '  ')  I  (exiet([file  '.sav'])  2) 

di8p( '  You  didn' 't  enter  a  valid  name,  back  to  the  beginning  •«.') 
had  input  >■  1; 

end;~%  if  ([file  '']—'•)  |  ... 
else  %  invalid  choice 

bad_input  ■1; 

di8p([10  'Oops,  you''ve  selected  an  invalid  choice.  Try  again.']) 
end;  %  if  (em8»l) 
end;  %  while  bad_inpit 

disp([10  'Hell  done;  "'  file  '.sav"  is  an  excellent  choice!']) 
dispiilO  'Loading  data  file  '  file  '.sav']) 
eval(['load  '  file  '.sav']}; 
disp( 'Loading  complete. ' ) 

clear  bad_input  fnum  file  %  clean  up  the  work  space 

runsim; 

disp((10  'At  your  leisure,  run  the  simulation.'  10  'It  will  run  for  '  ... 
sprintf( '%-3.1f  seconds. ',tfinal)]) 

return; 
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M  Fila  to  execute  oimulation;  called  from  "runme.m* 
Contains  moat  parameters  used  in  simulation  and  creates 
diary  fils  on  request 

Red  «  True  will  print  out  data  for  diary 


RUNSXH.M 
24  Jan  93 
Randy  Nelson 


global  Red  True  False  vemea  gravity  0 

global  ftut  t_reset  t_ahoad  max_ftut  max_rasat  look_ahead 

global  8tart_8tep  num~freq8  tfinal  fu*sy“time  “ 

global  min_radar_rng  max_radar_mg  Rng_n5ainal 

global  max~left_azim  max~right~azln  max_left_elsv  fflax_right_elev 

global  Xcm~Xcfflca  accal_llmits  vemea  min~vcmca_mLjc  Rc  ~  ~ 

global  lim_enable  setpoint  fuz  enable  pexy  max  cm_hpb 

global  azi~now_wt  rng_now_wt  slm__run_tlm  sljm_8tart_tima 

True  >  1;  False  «  0; 

sin^start  time  *■  { ] ;  %  stores  elapsed  time  of  simulation 

8imrrun_tTm  «  0; 

Rcd~>  False  ; 
nm  >  6076} 

gravity  >32.2;  %  ft/sec/sec 

deg2rad  >  pi/ieO; 

vemea  >  400*6076/3600;  %  400  kts  (in  ft/sec) 

inputC  What  value  of  look  ahead  time  do  you  want  to  use  (65,95  or  125)7  '); 
t^ahead  >  ans; 

if  0 

input ('  Output  data  to  diary  -  <T/N>?  *,'s')  ; 
if  (ans  mm  •Y')  I  (ans  ■«  'y') 

Red  •  True  ; 
diary  runsim.dat; 
diary  on; 
end 
end 

disp([10  'There  will  be  a  slight  delay  while  the  systca  iu  set  up.'  ... 

10  'Please  stand  by.']) 

%  Run  CMsys.m  to  define  the  state  matrices 
%  Affl,Bm,Qo,Dm 

% 

emsys 

%  Run  CMCRsys.m  to  define  the  state  matrices 
%  AcaK!a,Bcmca,Ccmca,Dcmca 

% 

cmcasys 

%  Run  simgain.m  to  determine  the  control  system  gains  (Rc) 


SampleTime  >1;  %  Discrete  sample  time 

simgain 


j 

4 


1 


1 


J 
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hors_rng  ■  8qrt(  (10'’6076)  *2  -  28000''2))  %  for  lOnm  slant  range 

%  ~  Initial  condition  for  CM  is  Xca 

%  Initial  condition  for  CMMCA  is  Zcmca 

Xcm  ■<  (horz  rng  1000  -1000  0  vcmca  0  0  0] '  7 

Xcmca  i  C  0  -29000  0  vcraca  0  0  0)  *  ; 

setpoint  ■  Xcm; 

t 


% 

% 

% 


SIMULATION  PARAMETERS  (default  values) 


%  *****  time  parameters 

tstart  -  U(l,l)  ; 
tfinal  -  U(length(U),l) 
ftut  <■  0; 
t  reset  >■  0; 

%€_ahaad  *  0; 
ffiax_ftut  -  10; 
ffiax~reset  >  max  ftut; 
loolc  ahead  -  (65  125  185}; 
8tar€_8top  >10; 
num_fraq8  >32; 


; 


%  start  time  is  first  element  of  column  1 
%  Pinal  time  is  laat  element  of  column  1 
%  Pinal  time  update  time 
%  Reset  time  (less  than  or  equal  to  ftut) 
%  Loo}c  ahead  time 
%  Max  delta  ftut 

%  Max  delta  reset  time  <>  max  delta  ftut 
%  vector  of  loo):  ahead  times 
%  step  thru  U  at  this  interval 
%  number  of  freq  intervals  loolced  at 


%  This  a  matrix  of  max  psd  values  for  a  (very)  long  random  CM  profile 
%  the  values  were  computed  in  '*pwr_max.m"  and  manually  imported  here 
pexy_max  >  [12.34  23.45  34.56;  %~max  value  of  'x*  psd 

~  45.67  56.78  67.89;  %  max  value  of  'y'  psd 

12.34  23.45  34.56;  %  max  value  of  'x*  95%  confidence  interval 

45.67  56.78  67.89  ];  %  max  value  of  'y*  95%  confidence  interval 

%  *****  simulation  parameters 

tol  >  le-2  ; 
minstep  >  le-0  ; 
maxstep  >  le+0  ; 
max_data_pt8  >  5000; 


***** 


%  Biax  rows  in  output  to  workspace 


% 

% 

% 


CMMCA  PARAMETERS 


%  *****  radar 

min_radar__rng  ' 
fflax~radar~mg  < 
Rng^ncminal  < 
fflax~left_aziffl 
max~right_aciffl 
max~down  elev 

max3>P_*^*v 


parameters 
■  5  *  nm; 

•  15  *  nm; 

•  10  *  nm; 

■-60  *  deg2rad; 

>  60  *  deg2rad; 
>-60  •  deg2rad; 

>  60  *  deg2rad; 


%  *****  velocity  limits 
vcmca_min  >  360  *nm/3600; 
vcmca^nax  >  480  *nffl/3600; 


***** 


%  *****  Acceleration  limits  in  the  body  axis 

%  -«■/-  esaximuffl  speed  change  in  feet/s/s, 

%  +  sideslip  g-limit  (not  currently  used), 

%  negative  g-limit  (positive  number  is  OK  if  < 

%  bank  angle  limit  in  degrees, 

%  roll  rate  limit  in  degrees/s, 

%  and  bank  angle  acceleration  limit  in  degrees/s/s 


1  9)< 


108 


iicc8l_liinitB  ■>  [  0  0  ... 

0  ... 
0.75*gravity  2.0*gravlty 
30*deg2rad 
d*deg2i‘ad) } 


%  — speed  accel  limits 
%  si.de  slip  limit 
%  min  and  max  g  limits 
%  max  bank  angle 
%  max  roll  accel 


t  *****  DIARy  DOIKGS  DOWN  HERB  ***** 
if  Red  ■“  True 

diBp(flO  10  ‘Prom  runsim.mt  '  10]); 

dispil'CH  initial  position  >  '  sprintf ( '%8.3f ' ,Xcm(l) )  '  '  ... 

8print£('%8,3f ',Xcm(2))  •  • 

sprintfC  %8.3t',Xom(3))  '  •  sprintf < •%8.3f • ,Xcm(4i ) ] ) ; 

diip(('  •  eprint£C%8.3£',Xcm(5))  '  '  ... 

aprint£(‘^8  3£‘,Xcm(6))  •  •  aprintf ( *%8.3f ' ,Xcm(7) )  •  '  ... 

Bprint£( '%8.3f\n' •Xcm;8) ) ] ) ; 

disp(['CMNCA  initial  position  ••  *  sprint£( '%8.3£' ,Xcmca(l) )  '  ’  ... 

aprintf ( ’%8.3f' ,Xcmca(2) )  *  '  sprintf ( '%8.3f ' ,Xcmca(3) )  '  '  ... 

aprintf ( '%8.3f ' ,Xcmca(4) ) ] ) ; 

disp(('  '  sprintf] 't8.3f',Xcmca(5))  '  '  ... 

sprintf (*%8.3f‘,Xcmca( 6))  •  *  sprintf ( •%8.3f* ,Xcaca(7) )  ‘  •  ... 

sprintf] 't8.3f\n' ,Xcmca]S) ) ] ) ; 
disp] [ 'tstart  >  •  sprintf ] '«8.3f' ,tatnrt) ]) ; 

dJ.sp]  [ 'tfinal  >  '  aprintf  ] '%8.3f‘ ,tfinal)  ]) ; 

dispii'tol"  •  sprintf ] '%8.3e' ,tol) ]) ; 

disp] i 'minatep  ■■  '  sprintf ] ‘%8.3e' ,minetep) ]) ; 

disp] ( 'maxstap  «  *  aprintf ] ’%&.3e' ,maxBt«p) ] ); 

disp] ['max  datajpts  «  '  aprintf] '%8.3f' ,max_data_ptB} ] )  ; 
al>accel  limits;  ~ 

disp] ( 'Airspeed  change  limits  •  *  sprintf]'  %8.3f  t8.3f'  ... 

,al]l),al]2))  •  feet/s/n'J); 

disp] { 'Sideslip  g-limit  ■  '  ... 

sprintf]'  %8.3f '  ,al]3) /gravity)  '  g"s’)); 

disp] ( 'Minimuffl/maximum  g~limita  ■  '  ... 

sprintf]'  %8.3f  /  %5.3f ',al]4) /gravity, al (7) /gravity)  '  g"s']); 

disp] ('Bank  angle  and  bank  accel  limit  ‘  ... 

sprintf]'  «8.3f  degs  %S.3?' ,al]S)*180/pi,al]6)*180/pi)  ... 

'  degrees/s/s* ] ) ; 

disp]('CMMCA  airspeed  limitst  min  A/S  «  '  ... 

sprintf]'  %3.0f  kts  ]%7.3f  feet/sec) '  ,vcmca  min*36C0/nai,vcirca  min)  ... 

10  '  max  A/S  -  '  ..r 

sprintf]'  %3.0t  kts  ]%7.3f  feet/scc) ' ,vcmca_max*3600/nffl,vcnca_max) ] ) ; 
diary  off;  -  ~  “ 

end 


return; 


I 


I 

j 


V 
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%  CMCAS7S.M 

%  1  D*c  92 

%  Or  Caughlin 

%  N  Fila  to  initiclize  the  cminca  ayatem  matrlcea 

%  Variablas  Acnca,  Bcmca  are  the  basic  ayatem  matrlcea 
%  Ccmca,  Dcmsa  are  the  output  matrices 

%  T 

%  X  >  [xl  x2  x3  x4  x5  x6  x7  x8] 

%  xl  •>  X  position 

%  x2  >  y  position 

%  x3  •  a  position 

%  x4  ■  bank  angle 

%  x5  ■>  X  velocity 

%  x6  ■  y  velocity 

%  X?  «  z  velocity 

%  x8  ■  bank  angle  rate 

« 

%  T 

%  u  >  [ul  u2  u3  u4] 

%  ul  ■  X  acceleration 

%  u2  «  y  acceleration 

%  u3  >  a  acceleration 

%  u4  ••  roll  acceleration 

global  Acmca  Bcmca  Ccmca  Dcmca 

w  >  .2;  «  w  la  really  the  parameter  "omega* 

Acmca  . 

CO  0  0  0  1  0  0  Of 

0000010  0; 

0000001  0; 

0000000  1; 

0000000  0; 

0  0  0  0  0  0  0  0; 

0  0  0  0  0  0  0  0; 

0  0  0  0  0  0  0  -w]; 

Bcmca  ■  . . . 

[0  0  0  0; 

0  0  0  0; 

0  0  0  0; 

0  0  0  0; 

1  0  0  0; 

0  10  0; 

0  0  10; 

0  0  0  w]; 

Ccmca  ■  ... 

(1  0  0  0  0  0  0  0; 

0100000  0; 

0  0  1  0  0  0  0  0; 

0001000  0; 

0000100  0; 

0000010  0; 

0  0  0  0  0  0  1  0; 

0  0  0  0  0  0  0  11; 
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Oomca  « 


[0 

0 

0 

0; 

0 

0 

0 

0; 

0 

0 

0 

0; 

0 

0 

0 

0; 

0 

0 

0 

0; 

0 

0 

0 

0; 

0 

0 

0 

0; 

0 

0 

0 

0]; 

if  Red  ■«  True 

■p  -  ’ 

diep((10  10  'From  cmcaaye.mt  '  10]) 
dl«p(tlO  'Acmee  -  •  10  •  •]) 

for  1  "  It 3 

diep([ep  eprintf  ( '%5.2f '  ,Acinca(l,l))  ap  aprintf  { •%5.2f '  ,Acinca(l,2) )  ep 
aprintf ( •%5.2f ' ,Acmca(l,3) )  ap  aprintf { •%5.2f’ ,Actnca{l, 4) )  ap  ... 
aprintf{  •%5.2f '  ,Acinca(l,5))  ap  aprintf  { •%5.2f’ ,Acinca(l, 6) )  ap  ... 
aprintf  (•%5.2f',Acmca(l, 7))  ap  aprintf  ( •%5.2f  ,Acn>ca(l, 8) )] ) 

end; 

diap([10  'Bcmca  ■  •  10  '  *]) 

£oir  1  •  1 1 8 

diap([ap  aprintf ('%S.2f',Bcmca(l,l))  ap  aprintf ( ’%5.2f ,Bcmca(l, 2) )  ap 
aprintf  { '%5.2f',Bcinca(l/'^))  ®P  aprintf  ( '%5.2f' ,Bcmca(l, 4) )] ) 

end; 

diap([10  ’Cemea  -  •  10  •  •]) 

for  1  “  li8 

diap([ap  aprintf ( '%5.2f' ,Ccmca(l,l))  ap  aprintf ( •%5.2f' ,Ccmca(l, 2) )  ap 
aprintf ( '%5.2f* ,Ccmca{l, 3))  ap  aprintf ( 't5.2f’ ,Ccinca(l, 4) )  ap  . . . 
aprintf ( '%5.2f*,Ccmca(l,5n  ap  aprintf ( ’%5.2f’ ,Ccmca(l, 6) )  ap  ... 
Mprintf(’%5.2f •,Ccmca(l,7))  ap  aprintf ( ’%5.2f' ,Ccmca(l, 8) ) J ) 

end; 

diap([10  'Dcnca  ■  •  10  '  ’]) 

for  1  *  1 <  8 

diapdap  aprintf  <'%5.2f',Dcmca(l,l))  ap  aprintf  ( •%5.2f* ,Dcinca(1, 2) )  ap 
aprintf (•%5.2f*,Dcmca(l, 3))  ap  aprintf ( •%5.2f’ ,Dcmca{l, 4) ) J ) 

end; 

end 

return 
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K  Fila  to  initlallzs  tha  cruise  miBsile  systeia  matrices 


CaiSYS.M 
1  Dec  92 
0.  Caughlin 


t  Variables  Acm,  Bern  are  the  basic  Bysteip  matrices 
%  Cem,  Dcm  are  the  output  matiices 

% 

%  T 

%  X  ••  [xl  x2  x3  x4  x5  x6  x7  x8] 

%  xl  ■  X  porjition 

%  x2  *  y  position 

%  x3  ■  z  position 

%  x4  >  bank  angle 

4  x5  «  X  velocity 

%  x6  >  y  velocity 

%  x7  •  s  velocity 

%  x8  >  bank  angle  rate 

%  T 

%  u  ■  [ul  u2  u3  u4] 

%  ul  >  X  acceleration 

%  u2  *•  y  acceleration 

%  u3  >  z  acceleration 

%  u4  >  roll  acceleration 

% 

%  NOTE  I  the  roll  rate  uiust  be  changed 
w  “  .1; 

global  Acm  Bern  Cem  0cm 

Acm«(0  0001000; 

0000010  0; 

00000010; 

0000000  1; 

0000000  0; 

0000000  0; 

0000000  0; 

0000000  --w]; 

Bcm*[0  000; 

0  0  0  0; 

0  0  0  0; 

0  0  0  0; 

1  0  0  0; 

0  10  0; 

0  0  10; 

0  0  0  w]; 

Ccrt>[l  0  0  0  0  0  0  0; 

01000000; 

0010000  0; 

0001000  0; 

0000100  0; 

0000010  0; 

0000001  0; 

00000001]; 
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Dcm»[0  000; 

0  0  0  0; 

0  0  0  0; 

0  0  0  0; 

0  0  0  0; 

0  0  0  0; 

0  0  0  0; 

P  0  0  0]; 


if  Red  -•  Truo 
sp  ■  '  ' ; 

di»p((10  10  'Froa  cmayH.mt  ’,10]) 
dUpdlO  'Actn  -  •  10  •  ’1) 

for  1  ■>  li8 

disp([Bp  Bprlntf ( •%5.2f •,Acm(l,l))  mp  BprintfC 
■printfC%5.2f,Acin(l,3))  up  sprintf{'%5 
■printf{*%5.2f,Acia(l,5))  sp  Bprlntf  {'tS 
Bprlntf (•%5.2f',Acm(l, 7))  Bp  Bprlntf {’^S 

and; 

dlBp({10  'Bern  -  •  10  •  •]) 

for  1  ••  li8 

dlBpifBp  Bprlntf (•%5.2f,Bcin{  1,1))  Bp  Bprlntf ( 
Bprlntf (•%5.2f,Bcm(l, 3))  Bp  Bprlntf (•%5 

and; 

dlap((10  'Cem  -  •  10  *  •)) 

for  1  ■  li8 

diB?([Bp  Bprlntf ('%5.2f,Ccm{l,l))  Bp  Bprlntf ( 
Bprlntf (’%5.2f',Ccm{l, 3))  Bp  Bprlntf (’%5 
Bprlntf (•%5.2f',Ccm(l, 5))  Bp  Bprlntf 
Bprlntf (•%5.2f,Ccm(l, 7))  Bp  Bprlntf (•%5 

and; 

dlBpdlO  'Dcb.  «  •  10  •  •)) 

for  1  *  lt8 

dlBpdBp  Bprlntf (•%5.2f ’,000(1,1))  Bp  Bprlntf ( 
Bprlntf (•%5.2f,Dcm{l, 3))  Bp  Bprlntf (’tS 

and; 

and;  %  If  Red  Trua 


>%5.2f ',Acm(l,2))  ap 
.2f,Aem(l,4))  Bp  ... 
.2f,Acin(l,6))  Bp  ... 
.2f,Acm(l,8))l) 


•%5.2f,Bem(l,2))  Bp 
.2f, 800(1,4))]) 


•%5.2f’,Cea(l,2))  Bp 
.2f',Con(l,4))  Bp  ... 
.2f’,Con(l,6))  BP  ... 
.2f,Cc«(l,8))J) 


•%5.2f*,Dem(l,2))  Bp 
.2f,Dem(l,4))]) 


raturn 


8IMQAIN.M 
1  Dec  92 
0.  Caughlin 
revieed 
9  Jan  93 
Randy  Nelson 

M  File  used  to  compute  the  Steady  State  LQG  regulator  gains 
Uses  Acmca,Bcmca,Bcmca,Ocmca  from  the  workplace  -  6  state  system 


xl  X  position 
x2  *  y  position 
x3  ■  s  position 
x4  ■  bank  angle 
xS  ••  X  velocity 
x6  ■  y  velocity 
x7  ■  s  velocity 
x8  ■  bank  angle  rate 


ul  ■  X  acceleration 
u2  ■  y  acceleration 
u3  >  s  acceleration 
u4  >  roll  acceleration 

Uses  weighting  functions  Q  &  R  from  this  file 


Design  an  LQO  regulator 

NOTBi  LQRDO  will  not  work  with  this  structure 
Reformulate  the  system  matrices  into 


xl  ■  X  position 
x2  X  velocity 
x3  <■  y  position 
x4  ■  y  velocity 
x5  *  s  position 
x6  ■  x  velocity 
x7  «  bank  angle 
x8  ■  bank  angle  rate 


Acmcal  <■  Acmca((l  526374  8], i); 
Acmcal  ■>  Acmcal (i,[l  5  2  6  3  7  4  8])| 

Bcmcal  ■  Bcmca([l  526374  8], t); 


Qc-ClOO  0  0  0  0  0  0; 

0000000  0; 

0  0  10  0  0  0  0  0; 

0000000  0; 

0  0  0  0  10  0  0  0; 

0000000  0; 
0000005  0; 

00000000  ]; 


Rc  -  (  1  0  0  0; 

0  10  0; 

0  0  10; 

0001  ]; 

[Kc,Sc]  «  lqrd(Acmcal,Bcnic&l,Qc,Rc,SaiQplaTliDa) ; 


% 

%  Rasat  control  and  Rlcatti  solution  for  original  atatea 

« 

Kc  -  Kc(t,(l  3  5  7  2  4  6  8]); 

Sc  -  Sc(t,[l  357246  8]); 

Sc  -  Sc([l  357246  8],t); 

claar  Acmcal  ilcmcal  %  claan  up  tha  workspace 

if  Red  Trua 
. ap  -  •  * ; 

diap((10  10  'Rrcm  simgain.mt  '  10]) 
diBp((10  'Qc  -  '  10  '  ']) 

for  1  ■  lt8 

di8p((8p  sprintf ( '%5.2f * ,Qc(l,l) )  ap  sp?intf ( '%5.2f ' ,Qc(l,2) )  sp  . . . 
apriiktf ( ’%S.2f ' ,Qc(l,3) )  ap  sprintf ( *%5.2f ' ,Qc(l,4) )  ap  ... 
aprintf ( ’%S.2f ' ,Qc(l,S) )  ap  aprintf ( '%S.2f ' ,Qc(l,6) )  ap  . . . 
aprintf ( '%5.2f ' ,Qc(l,7) )  ap  aprintf ( '%5.2f ’ ,Qc(l,8) ) ] ) 

and; 

diBp((10  'Rc  ■  •  10  ’  •]) 

for  1  lt4 

disp( [ap  aprintf ('45. 2f' ,Rc(l,l) )  ap  aprintf ( '%5.2f' ,Rc(l, 2) )  ap  ... 
aprintf ('%S.2f',Rc(l«3))  ap  aprintf ( '%5.2f' ,Rc(l, 4) )] ) 


and; 

diapC  ') 

diapC  liQO  Regulator  Design  with  raatructured  ayatem  oatriceai') 
dispC  ') 

diapC  - - - •) 

disp( ’  (K#S]  «  Iqrd ( Acmcal rBcmcal,Qc,Rc)  %  Cemputing  the  regulator  gain  K') 

diapC  4  and  aoln  to  Ricatti  agn  S') 

diapC  - ') 

disp([10  'Kc  -  '  10  '  ']) 


for  1  «  li4 

disp( [ap  aprintf ( '%S.2f' ,Kc(l,l))  ap  aprintf ( '%5.2f’ ,Kc(lr2) )  ap  ... 
aprintf ( '%S.2f' ,Xc(l, 3) )  ap  aprintf ( '%5.2f' ,Kc(l, 4) )  ap  ... 
aprintf ( '%S.2f' ,Kc(l, 5) )  ap  aprintf C%5.2f' ,Kc(l, 6) )  ap  ... 
aprintf( '%S.2f ',Kc(l,7))  ap  aprintf ( ’%5.2f' ,Kc(l, 8) )] ) 

and; 

disp([10  'Sc  >  '  10  '  ']) 

for  1  *  li8 

disp([Bp  aprintf ( '45. 2f' ,Sc(l,l))  ap  aprintf (’45. 2f’ ,Sc(l, 2) )  ap  ... 
aprintf ( '45. 2f',Sc(l, 3))  ap  aprintf ( '45. 2f' ,Sc(l, 4) )  ap  ... 
aprintf ( '45. 2f' ,Sc(l, 5) )  ap  aprintf ( '45. 2f' rSc(l, 6) )  ap  ... 
aprintf ( '45. 2f',Sc(l, 7))  ap  aprintf ( *45. 2f' ,4c(l, 8) )] ) 

and; 

and;  B  if  Red  »■  Trua 
return; 


i 

i 
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Appendix  D:  Matlab  M-flles  Called  by  the  Simulation 
This  appendix  contains  the  listings  for  all  the  M-files  used 
during  the  actual  run  of  the  simulation.  See  Appendix  C  for  more 
details  on  Matlab. 


function  inert  body2 inert (u) 

% 

% 

% 

%  This  accepts  a  6  x  1  vet^tor  as  inputt 
%  The  body  controls  (accelerations),  a  3  x  1  vector, 

%  and  the  three  euler  angles  (psi,  theta  and  phi). 

% 

%  Output  is  the  inertial  axis  accelerations  (3x1  vector) 

psi  -  u(4); 
theta  •  u(S); 
phi  -  u(6); 


B(»T2ZMSRT.M 
22  MOV  92 
Randy  Nelson 


*•*«*••**•***«***  Compute  transformation  matrix  0 


D  ■  seros(3,3);  %  speeds  up  memory  allocation  a  bit 

0(1,1)  >  coa(thsta)*cos(p8j ) ; 

0(1,2)  ■  cos(thsta)*sin(psi) ; 

0(1,3)  ■>  -sin(theta); 

0(2,1)  ■■  sin(phi)*sin(theta)*cos(pei)  -  coB(phi)*sin(psi) ; 

0(2,2)  >  sin(phl)*sin(theta)*sin(psi)  +  coa(phi)*cos(p8i) ; 

0(2,3)  ■  sin (phi )*cos (theta) ; 

0(3,1)  ■  co8(phi)*sin(theta)*co8(p8i)  *  sin(phi)*8in(psi) ; 

0(3,2)  B  co8(phi)*sin(theta)*8in(psi)  -  8in(phi)*co8(psi)i 
0(3,3)  ■  cos (phi) *cos (theta) ; 

inert  >  0**[u(l)  u(2)  u(3)]'i 


‘V..-  ...-/jL...  .:i  .. 


function  [naxt_hdg,next_azl]  ■  ... 

~  cm  n«xt(t  nextfCmmca  8tata,ctamca  hdg) 

%  -  _  _  -  ^  NBXT.M 

%  23~Jan  93 

%  Randy  Molson 

% 

%  Computea  CM  heading  and  azimuth  at  future  time 
%  Inputs t  the  future  time  (t_next), 

%  the  current  CHMCA  state  Jfor  inertial  position),  an  8  x  1  7actor, 

%  and  the  current  CMMCA  heading  (camca  hdg) 

%  Uses I  matrix  of  CM  headings  and  positions  (cm_hpb). 

% 

%  Outputs  CM  heading  and  azimuth  from  CMMCA  present  position 
%  to  the  CM'S  future  position 

%  matrix  is  in  one  second  intervals 

t_next  ■  round(min(t_next, length (cm_hpb) )) ;  %  &  stay  within  simulation  time 

next_hdg  >  cm_hpb(t_next,l) ;  %  CM  heading  at  t  next 

nextjpos  >  cm~hpb(t_naxt,2s3) '■•■Xcm(lt2)i  %  inertial  CM  position  at  t_next 

%  convert  CM  future  position  relative  to  CMMCA  present  position  to  an  azimuth 

%  *•**•*•*•*•****«•  Compute  transformation  matrix  d  ************ 

%  derived  from  D  with  theta  >  0  &  phi  ■  0 

d  ■  zeros(2,2);  %  allocate  space  to  speed  things  up 

d(l,l)  >  cos(cmmca_hdg) ; 
d(l,2)  •  sin(cmmca’'hdg) ; 

%D(1,3)  -  0; 

d(2,l)  ■  •sin(cmmca  hdg); 
d(2,2)  •  cos(cmmca  Edg); 

%D(2,3)  -  0; 

%0(3,1)  -  0; 

%D(3,2)  -  0; 

%D(3,3)  -  1; 

%  transform  to  body  axis 

rel_pos  ■  next_pos  -  cmmca_etate(l<2) ;  %  CMMCA  current  to  CM  future  position 

bodyjpos  •  d  *  rel_pos;  ~ 

%  Compute  azimuth 

naxt_azi  ■  atan2(bodyjpos(2),body_pos(l));  %  next_azi  in  t-pi,pi) 

return;  | 
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CatDBANK.M 
4  Dee  92 
Randy  Nelaon 


function  phicmd  «  cntdban]c(u) 

t 

% 

% 

%  This  accepts  two  column  vectors  as  input: 

%  the  euler  angles  psi,  theta,  and  phi  (yaw,  pitch  and  bank} 

%  and  the  inertial  controls  x,  y  and  z  (and  phi,  but  not  used). 

% 

%  Output  is  the  coomanded  beuxk  angle  phicmd. 

% 

pei  ■  u(l)i 
theta  -  u(2)i 
phi  -  u(3); 

%  *****************  Compute  transformation  matrix  D  ******* 

D  -  zeros (3,3) I  %  speeds  up  memory  allocation  a  bit 

D(l,l)  ■■  cos  (theta)  *coa  (psi) ; 

0(1,2)  *  co8(thsta)*8in(pai) 7 
D(l,3)  ■  -8in(theta)7 

D(2,l)  *  sin ( phi )* sin ( theta )*cos( psi)  -  coB(phi)*8in(psi) ; 

D(2,2)  ■  sin(phi)*sin(theta)*Bin(psi)  +  cos(phi)*co8(psi) 7 
D(2,3)  ■  sin(phi)*co8(theta) 7 

0(3,1)  >  co8(phi)*sin{theta)*coa(psi)  +  ain(phi)*sin(p8i) 7 
0(3,2)  «  cos(phi)*8in(thata)*sin(p8i)  -  sin(phi)*co8(p8i) 7 
0(3,3)  >  cos(phi)*coa(theta) 7 

%  *****************  Transform  inertial  accal’s  to  body  ************ 


Lb  •  0*{u(4)  u(5)  u(6)]'7  % 

%  *****  Compute  commanded  bank  angle 

if  (abs(Lb(2))  <  le>l) 

Lb(2)  >  Of 

and7  %  if  (abs(Lb(2))  <  le>l) 
if  (abs(Lb(3))  <  le-1) 

Lb(3)  Of 

end7  «  if  (aba(Lb(3))  <  le-1) 

phibody  ■  atan2(U3(2),  -Lb(3))7 
phicmd  >  phi  +  phibody7 
if  (phicmd  <  -pi) 
phicmd  <■  phicmd  -f  2*pi7 
elseif  (phicmd  >  pi) 
phicmd  a  phicmd  -  2*pi7 
end7  %  if  (phicmd  <  -pi) 

return 7 


3x1  vector  of  body  accel's 
***** 

%  make  sure  tiny  values  don't 
«  confuse  the  issue 

t  commanded  bank  angle  in  body  axis 
%  add  to  CMMCA  bank  to  get  net 

%  make  sure  angle  in  (-pi, pi] 


lie 


unction  anglss  >  eulerang(u) 

EOLBRANG.M 
15  D«c  92 
Randy  Nelson 

This  accepts  an  8  x  1  column  vector  as  input;  the  state  vector 
in  the  inertial  coordinate  F.O.R. 

{x,y,z  and  phi,  and  their  derivatives). 

Output  is  the  euler  angles  pai,  theta,  and  phi  (yaw,  pitch  and  bank) . 

Limits  on  angles! 

-180  <■  pal  <•  +180 
-90  <-  theta  <-  +90 

-180  <■  phi  <■  +180 


vcmca  "  norm(u(5t7))  +1;  %  add  1  so  velocity  is  never  zero 

t  A**********************  Compute  yaw  angle  pal  ************ 

%  same  as  heading  since  inertial  X  is  North. 

pai  ■  pl/2  -  atan2(u(S)  ,u(6) );  <-guad  arctan(vy/vx) 

if  psi  <  0 

pai  >  pai  +  2*pi; 

if  debugg  »  1,  pai>psi*180/pi,  end; 
and;  %if  psi  <  0 

%  ***********************  Compute  pitch  angle  theta  ************ 

%theta  ■  aco8(u(7) /vcmca)  -  pi/2; 
th«ta  ■  -a8in(u(7)/vcmca) ; 

%  ***********************  Compute  bank  angle  phi  ************ 
phi  «■  u(4);  %  straight  out  of  CMMCA  state  vector 

angles  ■  {psi  theta  phi]; 
return; 


119 


function  out 

% 


glmbal(u) 


%  Inputs  t 

%  the  CM  and  the  CHMCA  state  vectors  (inertial), 
t  and  the  euler  angles  (psi,  theta  and  phi). 


OXMBM..K 
7  Jan  93 
Randy  Nelson 


%  Output : 

%  the  CM  and  the  CMMCA  state  vectors  (inertial), 

%  the  euler  angles  (psi,  theta  and  phi), 

%  the  range  frcoi  CMMCA  to  CM  and  gimbal  angles  (psi_g,  thsta^g), 

%  *****  Attach  names  to  inputs  ***** 

cm_Btate  •  u(li8); 

enmca^state  >  u(9:16); 

psi  ”  -  u(17); 

theta  ■  u(18); 

phi  ■  u(19); 

%  *****************  Compute  transformation  matrix  D  ************ 

D  ••  seroa(3,3);  %  speeds  up  memory  allocation  a  bit 

0(1,1)  ••  cos(theta)*cos(psi) ; 

0(1,2)  >  cos(theta)*ain(psi) ; 

0(1,3)  -sin(theta); 

0(2,1)  <•  ain(phi)*nin(theta)*coa(psi)  >  cos(phi)*sin(p8i) ; 

0(2,2)  ■  sin(phi)*ain(thata)*sin(p8i)  +  cos(phi)*cos{psi) ; 

0(2,3)  <■  sin(phi)*coa (theta); 

0(3,1)  >  cos{phi)*Bin(theta)*coa(p8i)  sin(phi)*8in(p3i) ; 

0(3,2)  >  cos(phi)*sin(theta)*8in(p8i)  -  sin(phl)*co8{psi) ; 

0(3,3)  «■  cos  (phi)  *coa(  theta ) ; 


d  i  ■  cm  state(lt3)-cmmca_stata(li3); 
d^b  ■  0  *  d__i;  “ 


%  inertial  vector  from  CMMCA  to  CM 
%  convert  to  body  axis 


range  ■  norm(d_i); 


Compute  radar  range  ************ 


Compute  azimuth  (gimbal  psi) 


psi_g  «  atan2(d__b(2),d_b(l)); 


•  in 


Compute  pitch  (gimbal  theta) 


theta_,g  ■  -A8in(d_b(3)/range); 
giffl  ■  (range  pBi_g  theta_g]; 

out  [cm_stata;  cmmca_stata;  psi;  theta;  phi;  gim']; 
return; 


. . 


function  lB_now  aBi,B_now_hca,B_rng,B_ne3tt_azi,B  noxt_hca]  ■ 
“  Krd28(now_azi,now_hca,rng,next_azr,next__hca) ; 


% 

% 

% 

% 

% 

% 

% 

% 

% 

% 

% 

% 

% 


HRD2S.M 
6  Feb  93 
Randy  Nelson 


Thia  file  takes  the  inputs  and  maps  them  into  the  range  [-BrS] 

(if  out  of  [-5,5],  ”82fuz.m''  will  treat  as  if  at  end  of  range) 

Inputst  current  radar  azimuth  to  CM  (now  azi), 

current  CM-CMHCh  heading  crossing  angTe  (now^hca), 
current  range  to  CM, 

and  future  values  of  radar  azimuth  and  BCA  (nejct_azi  &  nsxt__hca) 

Output  is  the  scaled  levels  for  present  radar  azimuth  and  HCA,  range, 
and  future  (at  t^ahead)  radar  azimuth  and  HCA. 


%  *****  ocale  the  variables  ***** 

s__now_azi  ■  (now_a2i  *5*2/  (max_right_azlm-max_left_azim) ) ; 
s~now”hca  •  (now~hca  *  5  /  (3»pi/4)Ti  ~  “  ” 

8~rng~  ■  (rng-Rng  nominal)  *5*2/  (max_radar_rng  -  min_radar_rng) » 
s~next_azi  ■  (iiext_azT  *5*2/  (max_right_azim~majt_left_azim) ) ;  ~ 

8“next”hca  ■  (next”hca  *5  /  pi);  ~  ~  “  “ 


return; 


\ 


i 


•1 


j 
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function  [cmd  b&nk,ap8ed  chg]  «... 

iog_Eank ( now_azX, now_hca , rng, next^az  t , next^hca, cin_phi ) 

%  Inputai  now_azi,  now  hca,  rng,  next  azi,  next_hca,  cm  phi 
%  Uaest  caOiCA_max_baxiJE_angle  (accel_Timita(6)  )7  t_ahead 
%  "B2fuz.m"~  ~  ~  ~ 

%  Outputs!  CKMCA  bank  angle  and  speed  change  coimanded 
%  for  compute  the  next  set  point 


LOO  BAKX.M 
8  Fib  93 
Randy  Nelson 


%  Given  two  sets  A  and  B,  and  their  membership  functions  ml  and  ffl2, 

%  define  union,  intersection  and  complement  of  the  setsi 

% 

%  Intersection  corresponds  to  "ANOi"  m(A  AND  B)  «  min([ml(x)  m2(x}]) 

%  Onion  corresponds  to  "OR:"  m(A  OR  B)  «  max([ml(x)  m2(x)]) 

%  Complement  corresponds  to  "NOT:"  m{NOT  A)  «  1  -  ml(x) 

% 

%  Output  depends  on  where  centroid  of  logic  rules  falls  in  output's  fuzzy  set. 

% 


%  »**•****<;•*  Sets:  •****•«**«*« 

%  "A"  corresponds  to  present  radeur  gimbal  azimuth  (now  azi) 

%  "B"  corresponds  to  present  CM-to-CHMCA  heading  crossTng  ai^gle  (now_hca) 

%  "C*  corresponds  to  radar  range  (rng)  ~ 

%  "D"  corresponds  to  CM  bank  angle  (cm_phi) 

%  "Z"  corresponds  to  future  radar  gimbal  azimuth  at  t  ahead  (nsxt_azi) 

%  "F"  corresponds  to  future  CM-tc-faoccA  HCA  at  t_ahea3  (noxt__hea)~ 

%  "O"  is  interim  bank  angle  output  frcm  now_azi  and  now_^hca 

%  "H"  is  interim  bank  angle  output  from  range  and  CM  bank  direction 

%  «p"  corresponds  to  output  bank  at  t_,now  \ 

%  "Q"  corresponds  to  output  baidc  at  t^^next  \ _  to  be  converted 

%  "R"  corresponds  to  net  output  bank  ~  /to  set  point 

%  "S"  corresponds  to  output  speed  / 


speed_chg  «  0;  %  don't  impl«nent  speed  changes 


%  •**•*  Hake  appropriate  function  calls  to  eventually  get  ***** 

%  set  mendjership  levels  for  input  variables 


%  Hap  real  variables  to  scaled  integer  values  in  [<■5,5] 


ts__now_azi,s__now__hca,s_rng,s__next_azi,s_next_hca]  ■  hrd2s  ... 

”  ""(now_azi,now_hca7rng,next__azi,next_hca)  f 


%  Convert  scaled  values  to  fuzzy  set  levels 
[ALP,ASP,AZR,ASN,ALN]  «  a2fuz(s  now  azi); 
(BLP,BSP,BZR,BSM,BLN]!  «  a2fus(o7now~' hca); 
[C:.P,C8P,CZR,CSN,CLK]  «  s2fuz(s  rngj; 


«  present  CM-to*CMMCA  HCA 
%  present  radar  azimuth 
%  radar  range 


(BI.P,BSP,BZR,BSN,RLN]  «  s2fuz(s_next  azi);  %  future  CM-*to-CMHCA  HCA 

(FLP,FSP,FZR,FSH,FLN]  ■  a2fuz(8~next~hca) ;  %  future  radar  azimuth 
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oro  *0;  %  CM  bank  angle 

0Z5  «  0; 

OMS  >  0; 
if  (cmjphi  >  0) 

DPO  -  Ij 

elaeif  (cm  phi  <  0) 

DNB  »  1; 
alae 
DZB  -  1; 

and;  %  if  (cm^hi  >  0) 

%  Define  output  variable!  at  the  center  of  each  trapesoid 

LP  -  5; 

SP  -  2.5; 

ZR  -  0; 

8N  -  -2.5; 

LN  -  -5; 

%  ****«*«*•*•  ROLSSi  ************ 


t_now  logic  for  computing  bank  to  next  set  point  * 

~  based  on  * 

1)  radar  gimbal  azimuth  and  CM  to  CKMCA  HCA  * 

2)  range,  CM  bank  angle  direction  and  CM  to  CMHCA  BCA  * 


%  *****  Azimuth  and  BCA  logic  for  bank  **** 

ab  bank  ■>  [ 


AL?  BLR 

LP; 

%  la. 

If  A 

is 

LP 

AND 

B 

is 

LP 

THBH 

P 

is 

LP 

AL? 

BSP 

I.p> 

%  lb. 

If 

A 

is 

LP 

AMD 

B 

is 

SP 

THXM 

P 

is 

LP 

ALP 

BZR 

LP; 

%  Ic. 

If 

A 

is 

LP 

AND 

B 

is 

ZR 

THEM 

P 

is 

SP 

ALP 

B8N 

SP; 

%  Id. 

If 

A 

is 

LP 

AND 

B 

is 

SN 

THSM 

P 

is 

SP 

ALP 

BLN 

SP; 

t  le. 

If 

A 

is 

LP 

AND 

B 

is 

LM 

TaZN 

P 

is 

SP 

ASP 

BLP 

SP; 

%  2a. 

If 

A 

is 

SP 

AMD 

B 

1.8 

LP 

THBM 

P 

is 

LP 

ASP 

BSP 

SP; 

%  2b. 

If 

A 

is 

SP 

AMD 

B 

is 

SP 

THRN 

P 

is 

SP 

ASP 

BZR 

SP; 

%  2c. 

If 

A 

is 

SP 

AND 

B 

is 

ZR 

THBM 

P 

is 

ZR 

ASP 

B8N 

ZR; 

%  2d. 

Iff 

A 

is 

SP 

AND 

B 

is 

SN 

THEM 

P 

is 

ZR 

ASP 

BLM 

SN; 

%  2e. 

If 

A 

is 

SP 

AMD 

B 

is 

LN 

THBM 

P 

is 

SM 

AZR 

BLP 

SP; 

%  3a. 

If 

A 

is 

ZR 

AMD 

B 

is 

LP 

THXM 

P 

is 

LP 

AZR 

BSP 

SP; 

%  3b. 

If 

A 

is 

ZR 

AMD 

B 

is 

SP 

THBM 

P 

i 

SP 

AZR 

BZR 

ZR; 

%  3c. 

If 

A 

is 

ZR 

AND 

B 

is 

ZR 

THBM 

P 

is 

ZR 

AZR 

BSM 

SM; 

%  3d. 

If 

A 

is 

ZR 

AMD 

B 

is 

SM 

THBM 

P 

is 

SM 

AZR 

BLM 

SM; 

%  3e. 

If 

A 

is 

ZR 

AMD 

B 

is 

LM 

THBM 

P 

is 

LM 

ASM 

BLP 

SP; 

%  4a. 

If 

A 

is 

SN 

AND 

B 

is 

LP 

THBM 

P 

is 

SP 

ASM 

BSP 

ZR; 

%  4b. 

If 

A 

is 

SN 

AMD 

B 

is 

SI 

THEN 

P 

is 

ZR 

ASM 

BZR 

SM; 

%  4c. 

If 

A 

is 

SN 

AMD 

B 

is 

ZF. 

THBM 

P 

is 

ZR 

ASM 

BSM 

SM; 

%  4d. 

If 

A 

is 

SM 

AMD 

B 

is 

SN 

THBM 

P 

is 

SN 

ASM 

BLN 

SM; 

%  4e. 

If 

A 

is 

SM 

AMD 

B 

is 

LN 

THBM 

P 

is 

LN 

ALii 

BLP 

SN; 

%  5a. 

If 

A 

is 

LN 

AND 

B 

is 

LP 

THXM 

P 

is 

SN 

ALM 

BSP 

SN; 

%  5b. 

If 

A 

is 

LM 

AMD 

B 

is 

SP 

THBM 

P 

is 

SM 

ALM 

BZR 

LN; 

%  Sc. 

If 

A 

is 

LM 

AND 

B 

is 

ZR 

THBM 

P 

is 

SN 

ALM 

BSM 

LN; 

%  Sd. 

If 

A 

is 

LN 

AND 

B 

is 

SM 

THBM 

P 

is 

LM 

ALM 

BLM 

LM  ]; 

%  5e. 

If 

A 

i.s 

LM 

AMD 

B 

is 

LN 

THEN 

P 

is 

LN 
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%  ■»»«••*  Radar  range  logic  for  bank  **** 

%  need  to  know  which  way  to  turn  for  closure  when  CM  not  turning 
%  get  that  info  from  Bign(now_azi) i 
d  *  sign(now_czi) ;  ~ 


cd_bank  ■  [ 


CLP 

DPO 

LP; 

6a.  It 

C 

is 

LP 

AND 

D 

is 

POS 

THEN 

P 

is 

LP 

CLP 

DZS 

LP*d; 

6b.  If 

C 

is 

LP 

AND 

D 

is 

ZERO 

THEN 

P 

is 

s 

CLP 

DNS 

LN; 

6c.  If 

C 

is 

LP 

AND 

D 

is 

MEG 

THEN 

P 

is 

LN 

CSP 

DPO 

SP; 

7a.  If 

C 

is 

SP 

AND 

D 

is 

PCS 

TEEN 

P 

is 

SP 

CSP 

DZE 

SP*d; 

7b.  If 

C 

is 

SP 

AND 

D 

is 

ZERO 

THEM 

P 

is 

ZR 

CSP 

DNS 

SN; 

7c.  If 

C 

is 

SP 

AND 

D 

is 

NEG 

THEN 

P 

is 

SN 

CZR 

DPO 

ZR; 

8a.  If 

C 

is 

ZR 

AND 

D 

is 

POS 

THEN 

P 

is 

ZR 

CZR 

DZS 

ZP.; 

8b.  If 

C 

is 

ZR 

AND 

D 

is 

ZERO 

THEN 

P 

is 

ZR 

CZR 

DNS 

ZR; 

8c.  If 

C 

is 

ZR 

AND 

D 

is 

NEG 

THEN 

P 

is 

ZR 

CSN 

DPO 

SN; 

9a.  If 

C 

is 

SN 

AMD 

D 

is 

POS 

THEN 

P 

is 

SN 

CSN 

DZS 

SN*d; 

9b.  If 

C 

is 

SN 

AMD 

D 

is 

ZERO 

THEN 

P 

is 

ZR 

CSN 

DNS 

SP; 

9c.  If 

C 

is 

SN 

AND 

D 

is 

NEG 

THEN 

P 

is 

SP 

CLN 

DPO 

LN; 

10a.  If 

C 

is 

LN 

AND 

D 

is 

POS 

THEN 

P 

is 

LN 

CLN 

DZS 

LN*d; 

10b.  If 

0 

LiJ 

LN 

AND 

D 

is 

ZERO 

THEM 

P 

is 

S 

CLN 

DNS 

LP  ]; 

10c.  If 

C 

is 

i.N 

AND 

D 

is 

NEG 

THEN 

P 

is 

LP 

%  fuzzy  logic  computations  for  now^bank  components > 

%  append  column  for  logical  AND  of  now  az.i  and  now_hca  for  bank  angle 
ab_bank(t,4)  «  min(ab  bank(i,l),ab  ban}s(i,2)}}  ~ 

ab~bank(i,S)  ••  ab_ban]c( > ,3) .•ab  baHk(t,4); 

now^azi_hca  *  sufflTab_bank( : ,5) )7sum(ab_bank( t ,4) ) ;  %  scaled  value  from  azimuth 

%  append  column  for  logical  AND  of  mg  and  cmjphi  for  bank  angle 
cd_bank(<,4)  ■>  min<cd  bank(t,l),cd_bank(t,2)); 
cd~bank(t,S)  <■  cd_ban!lc(i,3).*cd_bank(t,4); 

rag__cmbanh  aum(cd_^bank(  t  ,5) )/sum(cd_bank( t ,4) ) ;  %  scaled  value  from  range 
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%  ********************************************************************* 

%  now_bank  logic  to  combine  fuzcy  bank  logic  dezlvoil  fron  * 

%  ~  current  azimuth,  HCA  and  range  * 

%  **•**«« **********A**Vk**************** ******************************** 

%  Convert  acaled  t_now  output  b2uik  values  to  fuzzy  set  levels 
(0I,P,6SP,GZR,GSN,GLN]  -  B2fuz(now_azi_hca) ;  %  present  CM-to-CHMCh  HCA 

[HLP,HSP,HZR,HSN,HLN]  >  s2fuz(rng2cnibank) ;  %  present  radar  azimuth 


now_bank  ■  [ 


GU> 

“hlp 

LP; 

11a. 

If 

G 

is 

LP 

AMD 

H 

is 

LP 

THEN 

P 

is 

LP 

GLP 

BSP 

LP; 

11b. 

If 

G 

is 

LP 

AMD 

B 

is 

SP 

THEN 

P 

is 

LP 

GLP 

BZR 

LP; 

11c. 

If 

G 

is 

LP 

AND 

B 

is 

ZR 

THEN 

P 

is 

LP 

GLP 

BSN 

LP; 

lid. 

If 

G 

is 

LP 

AMD 

H 

is 

SN 

THEN 

P 

is 

LP 

GLP 

HLN 

LP; 

lie. 

If 

G 

is 

LP 

AND 

H 

is 

LM 

THEM 

P 

is 

LP 

GSP 

HLP 

LP; 

12a. 

If 

G 

is 

SP 

AMD 

H 

is 

LP 

THEN 

P 

is 

SP 

GSP 

HSP 

SP; 

12b. 

If 

G 

is 

SP 

AMD 

H 

is 

SP 

THEM 

P 

is 

SP 

GSP 

HZR 

SP; 

12c. 

If 

G 

is 

SP 

AMD 

H 

is 

ZR 

THEM 

P 

is 

SP 

GSP 

HSM 

ZR; 

12d. 

If 

G 

is 

SP 

AMD 

H 

is 

SN 

THEM 

P 

is 

SP 

GSP 

HLN 

SN; 

12a. 

If 

0 

is 

SP 

AMD 

H 

is 

LN 

THEM 

P 

is 

ZR 

GZR 

HLP 

LP; 

13a. 

If 

G 

is 

ZR 

AND 

H 

is 

LP 

THEN 

P 

is 

SP 

GZR 

BSP 

SP; 

13b. 

If 

G 

is 

ZR 

AMD 

B 

is 

SP 

THEN 

P 

is 

ZR 

GZR 

HZR 

ZR; 

13c. 

If 

G 

is 

ZR 

AMD 

H 

is 

ZR 

THEN 

P 

is 

ZR 

GZR 

ESN 

SN; 

13d. 

If 

G 

is 

ZR 

AND 

H 

is 

SN 

THEN 

P 

is 

ZR 

GZR 

BLM 

LM; 

13a. 

If 

G 

is 

ZR 

AND 

H 

is 

LN 

THEN 

P 

is 

SM 

GSM 

HLP 

SP; 

14a. 

If 

G 

is 

SM 

AMD 

H 

is 

LP 

THEN 

P 

Is 

SR 

GSM 

HSP 

ZR; 

14b. 

If 

0 

is 

SN 

AND 

H 

is 

SP 

THEN 

P 

is 

SN 

GSM 

HZR 

SN; 

14c. 

If 

0 

is 

SN 

AND 

H 

is 

ZR 

THEN 

P 

is 

SN 

GSM 

HSM 

SN; 

14d. 

If 

0 

is 

SM 

AMD 

H 

is 

SN 

THEM 

P 

is 

SN 

GSM 

HIM 

LN; 

14e. 

If 

G 

is 

SN 

AMD 

H 

is 

LN 

THEN 

P 

is 

SN 

GLM 

HLP 

LM; 

15a. 

If 

0 

is 

LM 

AMD 

H 

is 

LP 

THEN 

P 

is 

LN 

OLK 

BSP 

LN; 

15b. 

If 

G 

is 

LN 

AND 

H 

is 

SP 

THEN 

P 

is 

LN 

GLM 

HZR 

LM; 

15c< 

If 

G 

is 

LN 

AMD 

B 

is 

ZR 

THEN 

P 

is 

LM 

GLM 

HSM 

LN; 

15d. 

If 

0 

is 

LN 

AMD 

B 

is 

SN 

THEM 

P 

is 

LN 

GLM 

BLM 

u*  ]; 

ISa. 

If 

0 

is 

LN 

AND 

H 

is 

LN 

THEN 

P 

is 

LN 

%  ***  fuzsy  logic  to  combine  azimuth,  hca  and  range  info  for  t__now  bank  *** 

%  append  column  for  logical  AND  of  now  azi_bca  and  mg__cmbBnk  for  bank  angle 
now_bank( I ,4)  «  min(now  bank( t ,1) ,now_EankT> >2) ) >  ~ 

now~bank(t,5)  >  now  banIE(i,3).*now_bank(t,4); 
now3t>euik  «  sum(now_Eank(  t  ,5)  )/8Uffl(ncw^^bank( >,4) ) ; 
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%  ********************************************************************* 

%  t_next  logic  for  computing  bank  to  next  set  point  * 

%  bv>aa<i~on  future  radar  gimbal  asimuth  and  CH  to  CkHCA  HCA  * 

%  Hit  Hint  %  *********«*****#4r****ii*************************'******<^********* 

t  Convert  scaled  next_azi  and  next^hca  bank  values  to  fuzzy  set  levels 


ef 

bank 

*  I 

- 

ELP 

FLP 

SN; 

16a.  If 

B 

is 

LP 

AND 

F 

is 

LP 

THEN 

Q  is 

LP 

BLP 

FSP 

SN; 

16b.  If 

E 

is 

LP 

AND 

F 

is 

SP 

THEN 

Q  ia 

LP 

EIJ> 

FZR 

SP; 

16c.  If 

B 

is 

LP 

AND 

F 

is 

ZR 

THEN 

Q  ia 

SP 

EZ.P 

FSN 

SP; 

16d.  If 

B 

is 

LP 

AND 

F 

is 

SN 

THEN 

Q  is 

ZR 

BLP 

FLN 

SP; 

16a.  If 

B 

is 

LP 

AND 

F 

is 

LN 

THEN 

Q  ia 

ZR 

BSP 

FL? 

SN; 

17a.  If 

B 

is 

SP 

AND 

F 

is 

LP 

THEN 

Q  is 

LP 

BSP 

FSP 

ZR; 

17b.  it 

B 

is 

SP 

AND 

F 

is 

SP 

THEN 

Q  is 

SP 

BSP 

FZR 

ZR; 

17c.  If 

E 

is 

SP 

AND 

F 

is 

ZR 

THEN 

Q  is 

ZR 

BSP 

FSN 

SP; 

17d.  If 

B 

is 

SP 

AND 

F 

is 

SN 

THEN 

Q  is 

ZR 

ESP 

FLN 

SP; 

17e.  If 

B 

is 

SP 

AND 

F 

is 

LN 

THEN 

Q  is 

SN 

EZR 

FLP 

SN; 

18a.  If 

B 

is 

ZR 

AND 

F 

is 

LP 

THEN 

Q  is 

LP 

BZR 

FSP 

SN; 

18b.  If 

B 

is 

ZR 

AND 

F 

is 

SP 

THEN 

Q  is 

SP 

BZR 

FZR 

ZR; 

18c.  If 

B 

is 

ZR 

AND 

F 

is 

ZR 

THEN 

Q  ia 

ZR 

BZR 

FSN 

SP; 

% 

18d.  If 

B 

is 

ZR 

AND 

F 

is 

SN 

THEN 

Q  is 

SN 

BZR 

FLN 

SP; 

18e.  If 

B 

is 

ZR 

AND 

F 

is 

LN 

THEN 

Q  is 

LN 

BSN 

FLP 

SN; 

19a.  If 

B 

is 

SN 

AND 

F 

is 

LP 

THEN 

Q  is 

SP 

BSM 

FSP 

SN; 

19b.  If 

E 

is 

SN 

AND 

F 

is 

SP 

THEN 

Q  ia 

ZR 

BSN 

FZR 

ZR; 

A 

19c.  If 

B 

is 

SN 

AND 

F 

is 

ZR 

THEN 

Q  ir 

ZR 

BSN 

FSN 

ZR; 

19d.  If 

B 

is 

SN 

AND 

F 

is 

SN 

THEN 

Q  is 

SN 

BSN 

FLN 

SP; 

19e.  If 

B 

is 

SN 

AND 

F 

is 

LN 

THEN 

Q  ia 

LN 

BLN 

FLP 

SN; 

f 

20e.  If 

B 

is 

LN 

AND 

F 

is 

LP 

THEN 

Q  is 

ZR 

BLN 

FSP 

SN; 

20b.  If 

B 

is 

LN 

AND 

F 

is 

SP 

THEN 

Q  ia 

ZR 

BLN 

FZR 

SN; 

%  i 

20e.  If 

B 

is 

LN 

AND 

F 

is 

ZR 

THEN 

Q  ia 

SN 

BLN 

FSN 

SP; 

%  ! 

20d.  If 

B 

is 

LN 

AND 

F 

is 

SN 

THEN 

Q  is 

LN 

BLN 

FLN 

SP  ]; 

20e.  If 

B 

is 

LN 

AND 

F 

is 

LN 

TBBN 

Q  ia 

LN 

%  stipend  column  for  logical  AND  of  next_azi  and  next_hca  for  bank  angle 
af_bank(i,4)  >  fflin(ef  bank(i,l),ef_bankX<r2})7  ~ 

af_bank(t,5)  ••  ef  ban]c( :  ,3) ef_bank(  <,4); 
next_bank  ■■  suffl(e?_bank( t ,5) )/sum(ef_bank( t ,4) ) ; 
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%  ••••*****•*••********••**••••••*••*******•**•*•*••***•**• 

%  logic  to  coinbins  presant  and  future  banV  conananda 

t  ••*******•*••***•***•******•***•*****•*•*•*****••*•****** 


%  Convert  ecaled  present  &  future  erod'd  bank  values  to  fuzzy  set  levels 
(PLP,PSP,PZR,PSN,PLN]  ■>  s2£uz(now  bank);  %  fuzzy  bank  crod  at  t_now 

[qI.P,QSP,QZR,QSN,QLN]  ■  B2fuz<nex€  bank);  %  fuzzy  bank  crod  at  t_next 


net_bank  ■  [ 


plp"qlp 

LPf 

%  21a. 

If 

P 

is 

LP 

AND 

Q 

is 

LP 

THEN 

R 

is 

LP 

PLP  QSP 

LP; 

%  21b. 

If 

P 

ie 

LP 

AND 

Q 

is 

SP 

THEN 

R 

is 

LP 

PLP  gZR 

LP| 

%  21c. 

If 

P 

is 

LP 

AND 

Q 

is 

ZR 

THEN 

R 

is 

LP 

PLP  QSN 

LP; 

%  21d. 

If 

P 

is 

LP 

AND 

Q 

is 

SN 

THEN 

R 

is 

LP 

PLP  QLH 

LP; 

%  21r. 

If 

P 

is 

LP 

AND 

Q 

is 

LN 

THEN 

R 

is 

LP 

PSP  QLP 

LP; 

«  22a. 

If 

P 

is 

SP 

AND 

Q 

is 

LP 

THEN 

R 

is 

LP 

PSP  QSP 

SP; 

%  22b. 

If 

P 

is 

SP 

AND 

Q 

is 

SP 

THEN 

R 

is 

SP 

PSP  QZR 

ZR; 

%  22c. 

If 

P 

is 

SP 

AND 

Q 

is 

ZR 

THEN 

R 

is 

ZR 

PSP  QSN 

ZR; 

%  22d. 

If 

P 

is 

SP 

AND 

Q 

is 

SN 

THEN 

R 

is 

SN 

PSP  QLN 

SH; 

%  22e. 

If 

P 

is 

8? 

AND 

Q 

is 

LN 

THEN 

R 

is 

SN 

PZR  QLP 

SP; 

%  23a. 

If 

P 

is 

ZR 

I  AND 

Q 

is 

LP 

THEN 

R 

is 

SP 

PZR  QSP 

SP; 

%  23b. 

If 

P 

is 

ZR 

AND 

Q 

is 

SP 

THEN 

R 

is 

SP 

PZR  QZR 

ZR; 

%  23c. 

If 

P 

is 

ZR 

AND 

Q 

is 

ZR 

THEN 

R 

is 

ZR 

PZR  QSN 

SN; 

%  23d. 

If 

P 

is 

ZR 

AND 

Q 

is 

SN 

THEN 

R 

is 

SN 

PZR  QLN 

SN; 

%  23e. 

If 

P 

is 

ZR 

AND 

Q 

is 

LN 

THEN 

R 

is 

SN 

PSN  QLP 

SP; 

%  24a. 

If 

P 

is 

SN 

AND 

Q 

is 

LP 

THEN 

R 

is 

SP 

PSN  QSP 

ZR; 

«  24b. 

If 

P 

is 

SN 

AND 

Q 

is 

SP 

THEN 

R 

is 

SP 

PSN  QZR 

*R; 

%  24c. 

If 

P 

is 

SN 

AND 

Q 

is 

ZR 

THEN 

R 

is 

ZR 

PSN  QSN 

SN; 

%  24d. 

If 

P 

is 

SN 

AND 

Q 

is 

SN 

THEN 

R 

is 

SN 

PSN  QLN 

LN; 

%  24e. 

If 

P 

is 

SN 

AND 

Q 

is 

LN 

THEN 

R 

is 

LN 

PLN  QLP 

LN; 

%  2Sa. 

If 

P 

is 

LN 

AND 

Q 

is 

LP 

THEN 

R 

is 

LN 

PLN  QSP 

LN; 

%  25b. 

If 

P 

is 

LN 

AND 

Q 

is 

SP 

THEN 

R 

is 

LN 

PLN  QZR 

LN; 

%  2Sc. 

If 

P 

is 

LN 

AND 

Q 

is 

ZR 

THEN 

R 

is 

LN 

PLN  QSN 

LN; 

%  25d. 

If 

P 

is 

LN 

AND 

Q 

is 

SN 

THEN 

R 

is 

LN 

PLN  QLN 

LN  1; 

%  25e. 

If 

P 

is 

LN 

AND 

Q 

is 

LN 

THEN 

R 

is 

LN 

%  append  column  for  logical  AND  of  now  bank  end  noxt__bank 
not_bank( I ,4)  ■  min(net  bank( i ,1) ,net_Eank( i ,2) ) ;  *' 

net*~bank( 1 ,5)  «  net  ban]i( i  ,3)  .•net  bank(it,4); 
net~bank_nean  ■  sufflTnet_bank(t,5))7auffl(net_bank(i,4)); 

%  ••«**  Convert  fuzzy  set  cocinanded  bank  value  to  hard  value  *••** 

cmd_bank  •  net_bank_mean  /  5  *  accel_llfflltB(6) ; 


return; 
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function  [SLP,SSP,SZR,SSN,SUI]  >  82fuz(8caled_lev8l) 

% 

% 

% 

%  This  file  takes  a  scaled  level  and  determines  membership 
%  level  in  all  linguistic  sets 

% 

%  Input!  scaled  level  [-5,5]  (e;:tra  values  of  ±99  on  each  end 
%  preclude  out-of-range  problems) 

% 

%  Output  is  a  5  X  1  vector  of  set  membership  levels 
%  All  non-zero  values  of  ”set_members"  have  membership. 

%  In  order  "scaled  large  positve,”  "scaled  small  positive," 

%  "zero,"  "small  negative,"  and  "large  negative" 

% 

%  *****  5  Linguiatic  sets  and  33  scaled  levels  [-^5,5]  ***** 

%  define  seta  as  trapezoids 

index  «  [-99  -5:5  99];  %  scaled  "universe  of  discourse" 

Linguiatic  set  ■  [ 

%  LM  SN~  ZR  SP  LP  Scaled  level 
1  0  0  0  0; 

1  0  0  0  0;  %  -5 

1  0  0  0  0;  %  -4 

0  1  0  0  0;  %  -3 

0  1  0  0  0;  %  -2 

0  0  1  0  0;  %  -1 

0  0  1  0  0;  %  0 

0  0  1  0  0;  %  1 

0  0  0  1  0;  %  2 

0  0  0  1  0;  %  3 

0  0  0  0  1;  %  4 

0  0  0  0  1;  %  5 

0  0  0  0  1  J; 

tab  ■>  [  index '  Linguistic_set  ] ; 

out  ■  tablal( tab, scaled  level); 

SLR  -  out<l); 

SSN  -  out(2); 

SZR  -  out(3); 

SSP  •  out ( 4 ) ; 

SLP  -  out(5); 

return; 


S2FOZ.M 
8  Feb  93 
Randy  Nelson 


fctflillflteiVlifiiriltfiiilllrwiTlliii^^^  inwliWilVhliiVi''-  '-''''•--HT‘rf'^"i 


i.vjai.i>^>.'»3iLu«  tliillir 


function  Lout  •  sat  xyz(u) 

%  -  SAT  r.fZ.M 

%  9  Jin  93 

%  Randy  Halson 

%  Input!  a  7  X  1  column  vsctor 
%  The  four  inertial  controls  (accelerations) 

%  (phi  acceleration  is  not  used), 

%  and  the  euler  angles  (psi,  theta  and  phi), 

% 

%  Uses  accel  limits  from  "runsim.m, "  a  1  x  8  vector. 

%  ■" 

%  Output!  a  3  X  1  vector! 

%  The  body  x,  y  and  z  axis  accelerations,  limited. 

psi  -  u(5); 
theta  ■  u(6); 
phi  -  u(7); 

Bero_tol  ■  l.Oe-4;  %  used  towards  end  of  file  when  scaling  accel 

if  0~  %  not  impl«anented,  but  available  if  needed 
if  abs(pai)  <  zero_tol 
psi  *0;  “ 

end;  %  if  aba (psi)  <  zero_tol 

if  abs( theta)  <  zero_tol  ~ 
theta  *0;  ~ 

and;  %  if  abs (theta)  <  zero_tol 
if  aba (phi)  <  zero^tol  ~ 
phi  •  0;  "" 

end;  %  if  abs  (phi)  <  zero^^tol 

end;  %  if  0  ~ 


D  ■  Eoros(3,3); 


D(l,l)  oos(theta)*cos(pai) ; 

D(l,2)  >  cos (theta) *sin(psi) ; 

D(l,3)  «  •■sin(theta) ; 

D(2,l)  <■  sin(phi)*sin(theta)*cos(psi) 
0(2,2)  >  sin(phi)*sin(thata)*sin(p8i) 
0(2,3)  ■  8in(phi)*co8(theta) ; 

0(3,1)  •  ooa(phi)*8in(theta)*cos(psi) 
0(3,2)  ■  co8(phi)*sin(theta)*8in(psi) 
0(3,3)  "  cos ( phi )*cos( theta ) ; 

Lb  «  0  *  u(l!3); 

Ob  •  0*(0  0  gravity]'; 

Lbl  «  Lb; 


Compute  transformation  matrix  0  ************ 

%  speeds  up  memory  allocation  a 


bit 


cos(phi)*8in(pci) ; 
cos(phi)*co8(p8i) ; 

sin(phi)*8in(p8i) ; 
sin(phi)*co8(p8i) ; 


%  convert  inertial  accal’s  to  body 
%  convert  inertial  gravity  to  body 


%  **********  limit  X  accel  ********** 

Ixnier  >  max ( ( accal_limit8 ( 1 )  ( vcmca_min-vcmca ) ] ) ; 

Upper  »  min ( [ accal~limits ( 2 )  ( vcmca~max-vcmca ) j ) ; 

if  (Lb(l)  >  Upper)  %  z  limited  by  throttle 

Lb(l)  <■  Upper; 
elseif  (Lb(l)  <  Lower) 

Lb(l)  ■  Lower; 
and;  %  if  (Lb(l)  >  Upper) 
if  (Upper  <  Lower) 

Lb(l)  ■  iBin( [Lower  Upper]); 
end;  %  if  (Upper  <  Lower) 

LS90ut(l)  ■  Ob{l)  +  Lb(l);  %  X  further  affected  by  gravity 
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%  **********  limit  Z  accel  ********** 

if  (phi*Lbl(2)  >  0)  %  rascals  commanded  control 

Lb(3)  -  U>(3)*Gb(2)/Lb(2); 

elsaif  (phi*Iibl(2)  <  0)  %  banked  in  wron?  direction 

1^(3)  *  (-gravity  +  u(3) )/cos(phi)  +  6b(3); 
end;  %  if  (phi*Lbl(2)  >0) 

Lb(3)  ■  -Gb(3)  +  Lb(3);  %  Z  due  to  gravity  and  backpressure 

if  (Lb(3)  <  -accel  limlts(5))  %  don't  over-g 

Lb(3)  ■  -accel__l3jnit8(5) ; 

elseif  (U>(3)  >'”-accel_limite(4) )  %  don't  under-g 

Lb(3)  «  -accal_limitsT4) ; 
end;  %  if  (Lb(37  <  -accei_limit8(S) ) 

%  **********  limit  Y  accel  ********** 

Lb(2)  -  0; 

%  can  go  at  top  of  function  w/ return,  do  it  here  to  get  debug  output 
if  (ab8(Lbl(2))  <  zero_tol)  &  (abs(Lbi(3))  <  zero_^tol) 
g_8  ■  l/coB(phi);  ~ 

Lout  ■  D'*[Lbout(l)  Lb(2)  -gravity*g  sj'; 

%di8p( 'herel' )  ~ 

else 

Lout  -  D'*[Lbout(l)  Lb(2)  Lb(3)J'; 

g_8  «  -U3( 3) /gravity; 

%di8p( 'herai ' ) 

end;  %  if  (Lbl(2)  0)  &  (Lbl(3)  -«  0) 

Lout (3)  «  Lout (3)  +  gravity; 

return; 
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function  setp  «  8et_pt(u) 

%  SET  PT.M 

%  24  3an  93 

%  lUndy  NalBon 

% 

%  Db**  fuzzy  logic  to  coinpute  Bat  point  in  CMMCA  body  axia 
%  Fuzzy  logic  providea  a  recooxaanded  CMIICA  bank  angle  and  apead  change 
%  Thia  info  ia  used  to  determine  where  the  CMMCA  would  be  at  the 
%  next  time  interval  aaauming  it  waa  at  the  deaired  bank  throughout 
%  and  the  airapesd  waa  changed  (once)  by  the  deaired  amount 
% 

%  Xnputat  a  23  X  1  vmctor  of  CM  &  CMMCA  atataa, 

%  euler  anglaa,  radar  range  and  gimbal  anglea, 

%  and  current  time  (t  now) 

t  Uaeai  CMMCA  deaired  Eank  angle  and  apeed  change  from  ”lo9_tab.m," 

%  fuzzy_time  (ftut,t_re8et,t_ahead)  from  "time_fuz.m, "  ” 

%  CM  nei^  (for  next  azi,  next  hca)  ~ 

%  “ 

%  OutputBi  CMMCA  aet  point  in  inertial  apace  (8x1  vector) 

% 


%  *****  Attach  namea  to  inputa 


cm_atate 

>  u(lt8) ; 

cmmca_8tata 

-  u(9tl6); 

pai  ” 

-  u(17); 

theta 

-  u(18); 

phi 

-  u(19); 

rng 

■■  u(20) ; 

giffl_pBi 

-  u(21); 

gim__thotn 

-  u(22); 

t_now 

-  u(23); 

***** 


if  iaempty ( 8im__Btart  time)  %  uae  Matlab'a  clock  to  figure 

aiffl^atart^time  ■  clock*  %  elapaed  time  of  aimulation 

end  “  “ 

if  t_now  >  tfinal  -  .25 

aim_run__tiffl  ••  etima( clock,  8im_8tart_time) 
end  “  ^  -  - 


%  ********  A  COOPLB  OF  CONTZHOENCIBS  BEFORB  FINDING  NEXT  SBT  POINT 
%  *****  akip  fuzzy  logic  and  revert  to  "refpoa.M"  ***** 


if  (fuz_enable  -1) 

aetp  ■  refpoa( [cm_8tate;  cninca_8tate] ) *  i 

return;  ”  ~  j 

end;  %  if  (fuz_enable  -1) 

%  *****  don't  recompute  aet  point  if  time  <  reaet  time  *****  | 

if  (t_now  <  t  reaet)  %  t  reaet  <■  0  initially,  ao  thia  ia  akipped 

aetp  ■  [aetpoint(lt3) ;  cmmca_8tati(4t8) ] ; 
aetpoint  >  aetp;  aet  the  global  variable 

return; 

end;  %  if  (t_now  <  t_re8et) 

%  *****  recompute  aet  point  if  time  >•  reaet  time  ***' 

%  or  if  time  *  tatart 

%  ***  gat  new  aet  of  fuzzy  timea  from  matrix  *** 

tiffl8_index  ■■  14round(t_now/atart  atep);  %  index  into 
delta_ftut  ••  fuzzy  tim5(time  index, 1); 
ftut  ■  ftut  +  delta_ftut;  “* 
t^reaet  ■  t^reaet  ■•‘~fuzzy_time(time_index,2) ; 


to  juat  conputed  value 


row  of  fuzzy^ti 
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%  9^t  CM  bank,  heading  and  heading  croeaing  angle 

t  _round  «  l+round(t_now) ;  %  index  into  row  of  cin_hpb 

CT_bank  ■  can  hpb(t_round,4) ;  “ 

<an~hdg  «  cm_Hpb(t_round,l) ;  %  from  matrix  of  values 

deXta  hdg  ■  rGm(2*pi  +  cin_hdg  -  pBi,2*pi)| 

if  delta  hdg  >  pi  ~  %  in  range  [-180,180] 

delta_Edg  “  dolta_hdg  -  2  *  pi j 
end;  %  if  dalta_hdg  >  pi 

%  get  future  cm  heading  and  heading  crossing  angle 
[next_hdg,next_aEi]  ... 

“  “  cm_next(t_now  +  t_ahead,cn]mca_^stata,p8i); 

%  future  HCA  based  on  future  CM  heading  and  present  CMMCA  heading 
next_hca  ■  rem(2*pi  +  naxt__hdg  -  pai,2*pi); 

if  nixt  hca  >  pi  **  %  in  range  [-180,180] 

next_Eca  ■  next_hca  -  2  *  pi; 
end;  %  if  n8xt__hca  >  pi 

%  *****  compute  the  set  point  in  the  body  axes  ***** 

[cmmca_bank,cmmca_spesd]  >  ... 

“  “log_bank(gimjpBi,delta_hdg,rng,next_a*i,next_hoa,cm__bank); 

▼el  >  norm(cinmca_8tate{5t7) ) ;  %  Compute  CMMCA  speed 

▼el  ■  ve.l  +  cnsnca_Bpeed;  %  and  incorporate  change 

if  cmmca_bank  0 

body_xy  ■  [vol*delta_ftut  0]; 
else  ~  ~ 

kl  ■  ▼el‘'2/(gravity*tan(cinmca_bank)); 

Jc2  <■  (gravity*delta_ftut*tan(«nmca_bank) }/vel; 
body_xy  ■  kl  *  [8in7k2)  l-co8(k2)7; 

end;  %  if  cmmca^bank  0 

%  *****  transform  into  the  (body  centered)  inertial  axes  ***** 

inert  ■  body2inert(  [bcxly__xy  0  psi  0  0]);  %  ref'd  to  zero  pitch  6  bank 

%  *****  convert  to  the  (true  origin)  inertial  axes  ***** 

xyz  >  inert  cmmca_8tate(l(3) ; 

setp  ■  (xyz;  cmmca_state ( 4 i 8 ) ] ; 

setpoint  •  setp;  ~  %  set  the  global  variable  to  just  cooqputed  value 


return; 
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